= alhoun 


Institutional Archive of the Naval Postgraduate School 





Calhoun: The NPS Institutional Archive 
DSpace Repository 


Theses and Dissertations 1. Thesis and Dissertation Collection, all items 


1986 


Real time programming of a robot. 


Souza, Paulo R. 


http://ndl.handle.net/10945/22064 


Downloaded from NPS Archive: Calhoun 


Calhoun is the Naval Postgraduate School's public access digital repository for 
(8 D U DLEY research materials and institutional publications created by the NPS community. 
«ist Calhoun is named for Professor of Mathematics Guy K. Calhoun, NPS's first 


7 i KNOX appointed — and published -- scholarly author. 
| inp 
LIBRARY Dudley Knox Library / Naval Postgraduate School 
411 Dyer Road / 1 University Circle 
Monterey, California USA 93943 





http://www.nps.edu/library 





pare ee De an Yy Bree 8: Alon | 
iter ih beri (# 
ala lanlath Mk 2 





























Pee As ed peel 
F Sahoo STAT Ln Lary ar 
Wdaelgo ed ae 
an eae At RENE Sor 





5 byUPL oe Be 
ES perep ry F535 waaay esters Ca Er ee 

Ae er opiates aE) Kr erp 
She IY ree aba AS tel ee 








aeied Bedite ith s nae | 2es 
rr ar At Nery ta 
it Leh Senne Paar Por rt 


tr tuck ba Le te ee} 


















Leen my ead eae 
ay Aa reat Soe tetris Po ey eee ae ay Yi ie inty OR 

[Xe Pride seo! Ps 7 od dt ork apts Fert Rett Sok] bree ay Pepa ek ar ee Chee ew Py yt tM 

an te ee eee ee eh ee oD oie he mae Cer Cre * eek atl RN idee Le ee NP rn ret at 
a oa me iss i abet ee igo a) es yes spire ae Viel re} he L "I bon indy) WpAp il smh o mee Tt) 

z a ey ee . tio Bh g dere) oot ote te Fa Pa rea eae bP Pe F Cir. be a oy ena lt 
Te if ot boasy Fe NSD AGEL rtd, Lon above a ee sey Bart pombe tle ir crop 
Beanies ele wax te PY AY Wes 





Ye mgetac aya 
wiaia Ara sae chy 
opted Le es hee CY eee 


























ere Retr temic 
To LA et LTE PRT Phy 
ole: paddy ee pare STEEP Ct Rar ry, pete fh rater 
rsa: b’e'h agp 7 nh oer Beery ty: rao Pal ae 
ada 3 sa aro 4 Me 
7 4 ae | 


, yee Le ee ee J A ae | nae ry 
K« tae is ca 3 Cire Se dey eee ene wit be Hird aaa 
Lh ie er kn ey ie ae ta A Py mae Les 
EAE OY woh CR EPAAL 2 Baden ier bi Madre O22, & let ag, 

prs rer, ee or sedge i 
eT eae VT te Pre dgs ae 


my baa 4:4. aad ead ve fea mel Seyi 
Oost | eee Ph Eg Ae ee ete Louiet 2 a re ot 
Ney DE ee ye Py Ree Deter lt Me tote tbs er 
a At Pere Pera Cee oe AOE Ta anc tare of aperi 

b Fa rt es ot barth MCR eetooe Be] Pte er] 
» Ps yr ae Ad cy is aes to ata rr Se a teen ee 9 
DU RC Hh ans arlene an 





a oy aot 
7 Siena fo 
a tae Bch i 

































i 




































































WA tA Me suites ed, ee) aa , ne 
Cot i 7 ie Veen ele DEL SOTO ont Cha 
ath d web A A hedery Pe erye oe eae vd Pa, ren a pia frre aL prestan eps sca 

Cipeete “pa she yee Let og Oa 2 Beaks A Be Pethe aee 4 eat te 
1.2 rte 9 Asm. Magy Ue en i eer PU Oded oy Tel ea Wi a Me non 

Nas} Lee er rE et pe eet COUR RA a 8 cet Tey Vr) 

“4A Cenk men 3 bie rs Pe et diana BTL | Crna Die ee ier en ‘Si 
ae ee Sate | Te aii OE 1 
pe Sa a Lae are ne ie 4 











Pe Mays ere dan ee 
om & Khe te 

be ROLE ea ee 
i Ge ers 


AP hilt SUAS Fi 
Pe a on ad ta pe tee EPP 
3 ae, 9, ead Crd waka oa Mey 
7 7 RA at iN ara ce w ainsaen MI. 


era 
Dade ae ee ct 
EDR Mer teed alee 


Drisd Ue 





73 rays 
eta Et oet ced ried pe LA) 
Loe ee aT a ae 


ea be ce hae pros ty 
LEE ee Ys “GF yes en Bo Ad 
hota LP eee 2 es 























. 
Lee avULa Wa yr aes ried et 


























































1 hi Pept rye 

Stebel Oe Yereen V4 eae HAMAD er. 

nee wr Le Ue Rae bru Wi tn Oe ie tree te) Dred ta ete Se Titan Vee gin: Mie 

ae ae Pyrerae ny 7m sal 4 bE So OO a ge tee en ee eee DD Sees en Lod oe va ok eee Cerri ys 

a Pad rye) Oa hey Li De ot ss 2 pha lo ee eS PS} La ae Sr Eee Ta ps beg 

ae Peer iyes Peel ro oe meas ¥ rt Peper ike pNaitighens arc itp Ercan | aes 

ee i ero AA ada 4 ang calad a tets wey Re Sek REGARD: ReRearhe 
fe as UdAe isu en ak " 

Pay 








Tater tony 

aed ee “ta Lads hcac (Ass han 

ea ee ks aes Pehl, Bene, ri 

. +f Uf Yi Cr a hy eee 

+ chy pa) Soiree rie) bated wet 

pie Caner A A tn Ne a Ae a oe 
Crier ara eee Pry X errs 

ne i eee ne a (rrr te RTs 


53-9 cl 
oa 5 


Ce Te 






. a Die | 
aro Oe Part? ane wate 
fh re ete | Rabie et ; ee 
oes Pi als te Zug ‘Re 
rf COL s were rent | 









oe Ce Ya oe 
ey err wp 
i ee 
























Ln ee Sn ont Pate a 
BFA ohh a a 
ae ot ee ay LAr Ee 


Y Aided nt 
oe et ee Cra Pe 


toa! F site) 
* 2 Bed edly dO eee AT ia cs ate Pet ae ee 
i 


















pale’, 
wren whom ty ee. 















bay ny aca 






















> eae 

Pu ae Tiet ta ape Rane At ea bao tae Ps tia oe 
bd 77 ee a ana a Ben " a 
ae moe Wye. or tt Pert a aed aioe: 














Te os Le Bees GH 







cr 
Rare tei Be PSY ae 
Dis hen, a tials ae Py ee co nr 2 vy ns 
Pee ate ae on re ra Enterta 2 % [ee : * rae cate cs ho rag poe 
ETT eo etl iar eT ; Ln i 
Cee Ae ; eet Pr he ea eye SMe ALY | pe . 
Me Rae Ls DE Mars DLE aE Cae) Be SEE ter pe t 









omy 
feta ata t 
War dane Pw Te 



























































































Cer es | 
haar Nieto thease rere pare a OE OCCT YR eh 
A ; TMbnGIn Ala 01 NY EY ne oe eer errr Ute ee BTL Leh 
on aL PEt Ve ie reer se Syanes nen ta P Sacstes: Oren a Ln orks OTT Terriers 2 tots 

ba Bg BATA © 426.064. de tee he eh Pere et ey a aay ed poet ren se 

a Pane aM +o erates Fale aa aeviRnE. ae en ete ah 
i a] 7. “4 74 if bal y 
F ri EPP ULE Lov ONY a 3 rate a 7 ‘a ether bs 
aa ”, ie oe 
A vara Cae) vite a rhe Pe da ety 
Ed 





C Fi. | 
Pe YET yep) nl 


peor eerie 
er A Gees | antl 


ore 

sitnsate bao pr carieniotrcrary 

Mo any ohh Tad (OF ae ne, i 

coud Meeraecr oa ay H c sire er 
“ve 

































Foe 





ms get 


Pe nee ee 


rare ett) HERE atoye ay 
pcre Pally R Ash le at ag “ii 













re 
Het ein nM 
eh dese Poe eyes ae Lah hee is 
rtd Hes Le ek a Le Weer 9) 
Cra om bri ara tets 
ae Pen i ‘. 
eds 7 


er ora 


dee ath) 
ars ae bie ees eras Part 


: ares ‘hf Prt ett 


TART ay Weiter 
SOL iy isda ta 
, Pea a teres 



































eer 
Pee NAR Raa 
a ae a 3 POSES che eye 
es | “athihaveadanrns Li SO tr ia a poe 
Bi Wade Sy myo ve tage. ware a 
: LT ea 4 ett 
Ind'v he? 3. 



























AY 

ale ; 
yee DID iA ss? share 
Darts Ri Soe Tre ort M3 PO ae 
‘ater wae BY Bae a woe 
43 


ro 
erry ae) 
pie? we Aa t 





ohare eae 
arpa het ia eed soe 
es eat nse RO hnuE a 

AL 
















Sa an é dea 







































a ne 
rey Ae tS oe 
of. wed he at ae grays ea : eee ne ie pet pier) "4 
Hi a et kere tans § 
Tee ra as eet 
is a he ra aOR 
ry oy ath 
id ‘ev 3 
can eee td 
or an Be AF EN 
nl 
bie 
N 
































bie? aia ard 
Pao Py hd ES DAS a a} rite 
arate Nea ry AEE RH 
pas * 


si ad 
is see Bia 


































a 


Se Sd 
2a 


=e 


wet Tie find 





























a 

Mak ata DNaed cy 

a RY , Ca aes 

: 5 ae tier 

M Per or bieed Maa Le aas Bipo Be Rees 
Ce ny San on cad rhe * 

yy ect Liew nd erry 

A Kt of v4 Psa ea Rone ind 

c att J EP M4 ata. i) Divi! Ta) 

re eo nas ess 

a Oe hs tau 







er ry 

Rie rea a oe 
oS kan ae) i te, 
ae 
ae | 


PN fe *. 
mY 





ed tote oe A ‘ 
vor ey ro a pup Pi 
oe Wh are Pd ree 
art Seah ias Peek YD 





eee ha) 
Sa Wd eee ed Wo Se 
Lee Te my 










eee 


Rd Ct eey fd 
Ul 
eas ri 


3 ey A 
aed 
cy 






























in ey 








Sed e 
of Ft ® 3 





=? Fels ea 
rh Parse ry ren 





Sion 
























’ ab hy ret ie 
oh ei fare 
Ad OST ee 
UR 4 Lee Mealy ek ee 
x 7 EDS ot ie 
tag has 

. 


fra 
a 





t- 
a a! Ley ae) 
bia dt TA ois 
“aged. Fat 






a 
wea meet 
My 
the 


a wha 


by 




























































































if ? 
4 Rey 
mee) 1%) ie a 
ie Ca 
bia ap 
S £7.94 
OSE ace 4 ae a 
Nie ieesrset ej J it id ee, cao 
LO ait ee oa eee Paria Pee 
"Ay Ser ee Py an BY AS eed a ed 
ie RO ie Oat Te + Sel ane 
oe ee Pp LE gs | 
a PETES: Rw 
erste pee 
PrN Rae yee OF PA Ans Riis ; 
ar a) a FE rina c et rae gs ant 
a t ° . 
Oe , Aas 
CON 





ae a Perens: 
i eur eg: 
yale ere 
eat eee cg uraig 



















































































ahs ek air he : 

eres 

i re ee aoe: eae 

Af Sd pt ph U ee 

fat BAS oa wie ee iy 4 
PARED bi 
he coe ra are At F 
5 4 tee gtaata foe ee at 
Pees a pessce fs Pray Stag ee a) rr i 
Pe an Cae 1 ceo Meee rs 4 . 

= sits Stele ha are) t Hi 1) i + E 

ai Ua ate i EST CRT et su, Pas 2 B 4 iar f ‘e a4 AE te Rie 

PR Re oc 3 SUG ee yeh eg 201 re rere kt ee ere 

P a P F ae f°9°sia 9 
bad ae ae ye ag 
or he 
iY 
; 
ae ee 
Cole Ly gov | 
% Lhd 5 Fa SEF 
Penney 
Sy LY 
eae #F wg Rie: ue 
Rat ae oe a 





a ay he te 
Wi Kore ny a 
at 


oe 


















Paar ar rie ey 
ut gs ie 






Ape E 
be ha 2 
















ae : 
i a i 
Ov shed fie ia 
Bk i) CaaS apt hse sa T's ae 
oF " Pa Rs err 
al Pal 




















4 | 
aa FR 


7 rH 









bar ta. : LP 
hk oe fe. hee ee 









Sd 
‘ FI a 
ee bees aay oF a + be 


i | 
a BO ae v3 ge ' oe e 
Mi a nee PM ie J 
















y co] 
ig a 
cee 
at ip a 


bess vie 


ee Pot 
‘ote gp) a pe: Pit 
a ok fee eae 
SUD ae 


ae 3 



































































Ls 
a 
an oes tf Pah rd 
pes ate os ny ee ae in or et } 
i E ja a aE bal a Pda fie a 
Zz: Bs Bt } hee P ah red ree ms 
cr ey ae oe aA a ate Rae e 
he haley rt ir beset “t 
et oe oes a 4 ly os 
; Rs 
at Ny ea 
"hos 
a 
i 






iw 


. 










anh BY 

ke Ponty ss 3 
Poe eo 

By fk en 

aa re Feat} 

Nara ite 

















MIG MEL. 1 gt 
Sree o F Pe ae rary 
, 7 F “ies F Fa Tew sleet eae 
r F . a er) ® ff t BL Boda nhs 
tpl 
ad rd . a » 
7 i Ps ® 2 , o 
nd rT ) . Oo 
4 
° ad ra Pa 7 A ' ’ $ 4 
« . - + ’ Let et at os ea They Siar 





ee 





DUDLEY KNOX LIBRARY 
NAVAL POSTGRADUATE ? 
MONTEREY, CALIFORNIA 93943-8 








NAVAL POSTGRADUATE SCHOOL 


Monterey, California 





KHESIS 


REAL TIME PROGRAMMING 
OF ee nOSo. 


by 


Paulo R. Souza 


December 1986 


Thesis Advisor Gee cenaler 





Approved for public release; distribution is unlimited. 


1233055: 


“ae 














“ORITY CLASSIFICATION OF THis PAGE 
REPORT DOCUMENTATION PAGE 


REPORT SECURITY CLASSIFICATION 1b RESTRICTIVE MARKINGS 
UNCLASSIFIED 


SECURITY CLASSIFICATION AUTHORITY 3 DISTRIBUTION / AVAILABILITY OF REPORT 


Approved for public release; 
 DECLASSIFICATION / OOWNGRADING SCHEDULE a 1 S bt Lbut ion 1 Sin 1 imi ted 


PERFORMING ORGANIZATION REPORT NUMBER(S) S MONITORING ORGANIZATION REPORT NUMBER(S) 


NAME OF PERFORMING ORGANIZATION 6b OFFICE SYMBOL 
(if applicable) 


7a. NAME OF MONITORING ORGANIZATION 


aval Postgraduate School Naval Postgraduate School 


OZ 
ADDRESS (City, State, and ZIP Code) 7H ADDRESS (City, State, and ZIP Code) 





onterey, California 93943-5000 Monterey, California 93940-5000 


NAME OF FUNDING /SPONSORING 
ORGANIZATION 


8b OFFICE SYMBOL 
(if applicable) 


9 PROCUREMENT INSTRUMENT IOENTIFICATION NUMBER 










AOORESS (City, State, and ZIP Code) 10 SOURCE OF FUNDING NUMBERS 


PROGRAM PROJECT Task WORK UNIT 
ELEMENT NO NO NO ACCESSION NO 





TITLE (include Security Classification) 
REAL TIME PROGRAMMING OF A ROBOT 


PERSONAL AUTHOR(S) 
Souza, Paulo R. 


] TYPE OF REPORT 136 TIME COVERED 14 OATE OF REPORT (Year, Month, Day) iS PAGE COUNT 
aster's Thesis FROM TO 1986 December ee 


SUPPLEMENTARY NOTATION 


COSAT!I CODES 


FIELO SUB-GROUP 


18 SUBJECT TERMS (Continue on reverse if necessary and identify by block number) 
Robot - Real Time Programming 
Autoadaptive model 






ABSTRACT (Continue on reverse if necessary and identify by block number) 


Two difficulties that arise in controlling a robot arm ony are the changes in 
inertia and the lack of a velocity feedback. The inertia of the arm varies when the 
robot picks up or releases a load and the velocity would need a tachometer to be 
measured (expensive and not practical). One way to overcome those problems is to use 
an autoadaptive model to represent the plant. If the model "follows" the plant 
transfer function and both have the same input, the model can have velocity feedback 
and the effects will be reflected in the plant. The solution presented above was 
llnvestigated and simulated in DSL by Kenneth R. Wikstrom, in his thesis from NPS in 
september of 1986. In the present research, a hardware and assembly software was 
eared and implemented based on the same structure mentioned in that thesis. The 
lock diagram and autoadaptive algorithm were slightly modified and the plant was 
Simulated in a dedicated analog computer. Two transfer functions were tested in the 
analog plant: a disk drive motor and a robot motor. 


} 


| DISTRISUTION/ AVAILABILITY OF ABSTRACT 21 ABSTRACT SECURITY CLASSIFICATION 

4 UNCLASSIFIED/UNLIMITEO  () SAME AS RPT (ypc Users UNGUCASSIFIED 

| NAME OF RESPONSIBLE INDIVIDUAL 22b TELEPHONE (Include Area Code) | 22c OFFICE SYMBOL 

| fe. J. Thaler -408-6247980 Os 

| 3 
FORM 1473, 84mar BS APR edition may be used until exhausted SECURITY CLASSIFICATION OF THIS PAGE 


Allotner editions are obsalete 


1 


Approved for public release; distribution 1s unlimited. 


Real Time Programming 
of a Robot 


by 


Paulo R. Souza 
Captain. Brazilian Air Force 
B.S., Instituto Tecnologico de Aeronautica. Brazil, 1979 


Submitted in partial fulfillment of the 
requirements for the degree of 


MASTER OF SCIENCE IN"ELECTRICAU ENGI Ee as 


from the 


NAVAL POSTGRADUATE SCHOOL 
December 1986 


ABSTRACT 


Two difficulties that arise in controlling a robot arm (plant) are the changes in 
inertia and the lack of a velocity feedback. The inertia of the arm varies when the robot 
picks up or releases a load and the velocity would need a tachometer to be measured 
(expensive and not practical). One way to overcome those problems is to use an 
autoadaptive model to represent the plant. If the model “follows” the plant transfer 
function and both have the same input, the model can have velocity feedback and the 
effects will be reflected in the plant. The solution presented above was investigated and 
mommared in DSL by Kenneth R. Wikstrom, in his thesis from NPS in September of 
1986. In the present research, a hardware and assembly software was designed and 
implemented based on the same structure mentioned in that thesis. The block diagram 
and autoadaptive algorithm were slightly modified and the plant was simulated in a 
dedicated analog computer. Two transfer functions were tested in the analog plant: a 


disk drive motor and a robot motor. 


lid 


TABLE OF GOs iaa 


I. INTRODUCTION .......00. 0005 0 9 
ile THE PROPOSED SYSTEM ...... . SRR ee 15 
A. INTRODUCTION ..............098) ls 

B. MODEL AND CONTROLLER (2333 13 

C. THE PLANT........00.. 05. 5 ue en 15 

D. THE IDENTIFICATION ALGORITHM ye 15 

ITI. SOFTWARE DESIGN = 16 BETS . . 5 18 
A. INTRODUCTION ...........72%. 3 eee IS 

B. MAIN PROGRAM .. 2.005... 45 7 Seen 18 

C. SUBROUTINES ...... 0.00%... 05 3 ee 29 

lL. The Subroutine ANALOG ...... [3 30) 

2. The Subroutines of Basic Operations | 722 ao 

3. The Subroutines OUTOP and INOP 2.223 38 

4,. The Subroutine CURVE .. 0... 34 

5. The Subroutine WALG ...........2... 55 ee 34 

6 The Subroutine STORE. .....4.4...0.23 ee a9 

7, The Subroutine DISPLAY |... ...)- geen ie 35 

S. The Subroutine TRANSEER [3 2 3h 

IV. HARDWARE 2.0.0 cbc eo eo 5 os Henn tgs ne 33 
AL GENERAL 2.5 cece a ee oe 

B. THE MICROPROCESSOR (3 53 

C. THE ARITHMETIC PROCESSING GN 3 

l. Subtraction Routine. 22... nee eee eee 60 

2. Multuply Routme ....... 2439 eee 60 

3. Square Root Routine .22 2 73 60 

D. THE INTERFACES... .... 703 61 

E. THE PLANT.....00.. 000 000 66 


Ve. Bee ee em Wer res Ole UE SY SV. ok ee eee eee 76 


Peter e mle PROBLEM ......6.82...4- De AAS 2, Sk Guan eae 7: 76 
ede tee re ra, iii 
Wil. MeN@be Oo AREAS FOR FURTHER STUDIES ©... nck. cee. 89 
Pe eOi cnr COCA VID VIODEI.- 16 BINS 2. eke eee ee eee ol 
une e Wi VIO NIOR ee be eee ee eee 98 
I POV oben | URES mig eke wee ea wee bbe eee 9$ 
oe OO @ems OG RAMS. 2. ea ee Mee a. oF 
eee SOIN C2 EOUIPMIENT AND OPERATIONAL PROCEDURES ...... Ee 
E ee eee Alcea lite OIE Gre oni aS Pes a a ake es ee ee [13 
D fee Oe Det. ee Pee ee a dl. aaa ed ek ee ee ee ee lS 
RS em Mem ee ee ee ee ee ccc eee ee eee is 
Rr Web sstola LO S LIS Pe 2 oat ehh eee be ae nee eae 116 


Ca 


OOo OX. 


LIST OF Tages 


MENMIORY ORGANIZATION 2.2.2... 25 2 eeeeneneney n= 22 
DATA ENTRY AND DATA REMOVAL PROCESS Se 5o 
SUBTRACTION ROUTINE FOR TESTING TEE GASE pee 61 
MULTIPLICATION ROUTINE FOR TESTING WE ir Ce 62 
SQUARE ROOT ROUTINE FOR TESTING The ee 63 
NUMBERS INSIDE AND OUTSIDE THE VICROPROGESSOn ae 65 
COMPATIBILITY TEST BETWEEN ADC AND DAG an 66 
THE SCALE PROBLEM .............+.4.44. 9 or ie 


tJ perry pet 
ho 


GI NH lV 
No — &e hl 


(42 


(2 fy lao Gs 2 td 
~jJ GN Gn FH Ga 


2 
Oo © 


10 


td 


(42 
— 
— 


12 
a 
14 
ID 
16 
i 
18 
alive 
19 
aC 
3.19d 
5.19e 


Gs Me Ley {42 Gl G2 Gl tad G4 


Go 


LishOr FiGuUNES 


SMM CmMIOCK yaaa Of LHe SVSHEMNe sas ss a. dena ess. Allen... 10 
iem@entralCompouter and the lerminal Vlicroprogessors .............. 2 
TIRE IPP OIE TOVSTETOER SS S172 0 GV Snr ocr 14 
SOC UIOEM ROMER A aku h.k aga yee OO eae a ee ee vd ewa eee 15 
emo On I ROCESS. ce Ae eine Ss da Me ee ee. 16 
Seam unimo Mean ia l@ CMC ieee. oon. ee eo ens ee eee We 
eee eae CeO Open pei ae eae ied as. ee wee es 22 
Te Signa eieekesesinoees JE) enkwelot yee 12), 5 a ar 4 
Rie. eimai Ciertine = oh WOVWOMGE Gare ee ee ee ee 26 
Stccen Rem ROCratl — MlOMCMant Dw uc eo. aba ye Bea eee pease ee 28 
Siectee mr deel ie cnall Gummer ys OR a eM ee ee we ew eee Bae, 
Seem aim mona = lOweicdti wake 26 hake PR. ee ee ee ee es OO 
Poole m@mimecrason Usiieume @OLreClOL FaclOl 2.5.2.6 oe eevee es Br 
Sort nMmiun@eicMemIeIORVelidkt fae. cee ese ge ce ee be we cc es D2 
Ae ee Mine ba iemerON Clary Geo... 25 2k ss. . = eee. . se... 38 
Siireae Rehm ho Cmrinpe mao GMAT Itt se oda « dawguiele. «25 vane eee ee Bh 
Prem ne MUMNGe AOC rt in ee eG Ee sa sch ae ney Dee ee ee oe 40 
emo ONO inceOn DasiG@ I OCTATIONS Wh... 6 ee ccc cte eyes Hele eee re yee ele 4] 
Mem eC inet OOM ee ey ee ya heey a td va eee ERE Pe eS 42 
BRCM OUNOMOINLIe MOD cayqeiais. de oak eee ee dia eee baa e ee dee 43 
UNCMSTIMGORR@eNCnIn Conte see oe ce cies a ssw Bae es chee aa. ee. 44 
Bem NOM aa eM ale lo ys aoe agen eee 04 4 ce eeseale aoe wee woes 45 
Heme io Mme SO Ren euety ey ec ae ee wv ds et ek we ew ew eles 46 
TRE SOON ate ID Sie) (sa eae nr 47 
iirem POmOluntime IO IS@iay oe 1... on ie ee Re Sb ee eee. 48 
VEE SiO UECEOIES IOI 0) ts a ee 49 
Pome meio MOIG DIAN Raye yk cc tees ee ee ee eee 30 
Seem Momomme MOI OI AWer (ci uk sds ee oe ss baht ee ee wk ee eee oy 


Sa) 
4 
4.2 
4.3 
4.4 
4.5 
4.6 
4.7 
4.8 
49 
4.10 


cn Cn Car Ga Cn Jv tan in tan 
Vo CO -~3 Gs Ca £. Gi to 


Can 
— 
=> 


The Subroutine LONGDIV ........ 70 See 2 


The Microprocessor and Interfaces . > 7) jesse teen 54 
32 Bit Floating Point Register . . . . .[)gipeemeney stele seen 57 
Example of a 32 Bit Floating Point Number 2) 7g 58 
Stack Configuration for APL 8231 . . 2 Se ee 58 
Digital to Analog Comverter ..... . . 7.) Renee 64 
Plant Transfer Function ......... 7... sy eaemeeie ttre tess 67 
Analog Plant ........02:08..¢22.. 0. | 9 6$ 
Double Integrator .................. See Se 70 
Comparison between Digital and Analog Integrators 92). ee 71 
The Second Integrator .........554 5... san tanner iS 
Testing the First Block of the Plant .... 2...) 7323 74 
Position and Velocity for a Disk Driver Motor. R = 013! rad eee 79 
Position and Velocity for a Disk Driver Motor, R = O62 ad") eee SO 
Position and Velocity for a Disk Driver Motor, R = 1223 cade 1 
Position and Velocity for a Disk Driver \lotor, R = 250m ad 82 
Position and Velocity for a Disk Driver Motor, R = 3.) tuad) 7) eee 85 
Position and Velocity for a Disk Driver Motor, R = 4:38irad) >) eee 84 
Position and Velocity for a Robot Motor, R = O.62 rad ee 85 
Position and Velocity for a Robot Motor, R = 1.25 rad) 86 
Position and Velocity for a Robot Motor, R = 2.50 rad. 7.7) eee 87 
Position and Velocity for a Robot Viotor, R = 3.11) rad. 7 8S 


i. INTRODUCTION 


The positioning of a robot arm with just one degree of freedom can be a hard 
task if some constraints are imposed by the problem. Some of the requirements and. or 
restrictions can be: 


eeeeNCCUIACY. 


2. Muinimum time. 

pee Oo. O Ver Shoot. 

4. Velocity measurements are not available. 
5. Loads can be changed during operation. 


The accuracy and overshoot are common requirements and will not be discussed. 
The minimum time requirement is,in a wav, incompatible with the lack of a tachometer 
femprovide velocity measurements. How can the motor achieve the required position 
with no overshoot and minimum time without the knowledge of the velocity along the 
trajectory? It cannot be done unless the velocity can be guessed using the position 
information that is readily available. In this case the curve following method can be 
Used and the arm will be decelerated after some suitable point in the trajectory. 

What is the effect of changes 1n the loads? They will modify the inertia of the 
system and the transfer function of the plant. So, a real time identification algorithm 1s 
needed to detect inertia changes and update the controller. 

With these constraints and solutions in mind let us analvze the scheme proposed 
in Figure 1.1 . The plant represents the arm and motor of the robot. The model is a 
very simple approximation of the plant. Both model and plant are driven by the same 
input. The identification algorithm receives both outputs, identifies the actual plant 
f eaimeters and updates the model in order to keep CM and CS as close as possible. 

ie stheotetical scheme was treated in [Ref. 1] and will not be detailed here. 
Meormever, the block diagram will be explained in Chapter I]. The purpose of this 
hesearchh was to implement the real time svstem using a microprocessor. in a 
Preropoard fevel, the model and controller were implemented by software in the 
microprocessor and the plant was simulated using analog hardware. 

When the desired position is achieved the controller, that was in “bang-bang” 


mode, can be switched to a linear compensator. This feature is important but was not 
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Figure t.1 Simplified block diagrany Gf the se sme 


implemented in this thesis since our goat was to prove the feasibility of the 
autoadaptive alvorithm using a servo svsteni as a controller. 

The identification algorithm was chosen to be efficient and simple. The algorithm 
used in thts thesis is found in [{Ref. 1] and will be referred as “The WiksSumem 
Algorithm”. It will be briefly discussed in Chapter I] and the software implementation 
will be presented in Chapter [II (subroutine “Walg”). 

The proposed svstem studied on a block diagram basis is presented in Chapter IT. 
The 16 bits software design is discussed in Chapter II]. Chapter 1Y presentsmaae 
hardware for the analog plant and the microprocessor. The results are presented in 
Chapter V. The conclusions and some possible areas to be studied are treated in 
Chapter VI. The [6 bit program (called “Mlodel’) and the monitor procranie 
presented in Appendices A and B. respectively. The procedures to operate theuitaaaee 
dre diSeussed ine peeing: 

The Z-SO microprocessor was chosen to implement the svstem for three main 
reasons: 


l. The monitor was already developed and, with small changes, could providesal 
the support needed to run and debug the scimwa 
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2. The author is very familiar with this microprocessor. 


The time requirements to operate a robot arm are nota constraint to the use of 
MisemMcromnacesson, mete Other had, the idea behind the model.controller 
and algorithm is still valid for a faster microprocessor. 


G2 


All the software was developed using the Z-100 and Data I,O in the Digital Lab. 
Mille programs were stored on floppy disks, under CP/M operational svstem, and 
mem@icerrcd tO EPROV s via Data 1/O. Once in EPROM S they were installed in the 
protoboards and then executed using the monitor. The debugging process was done 
using some features of the monitor that will be explained later on. 

The microprocessor and interfaces treated in this research can be considered as 
individual parts of a large svstem. Suppose a robot with multiple arms, mechanically 
coupled by joints. Each arm will have a terminal microprocessor (TM). This 
microprocessor implements the model, controller and updating algorithm accomplished 
in this thesis. The position input for each arm is commanded by a central computer. 
This command is applied directly to the corresponding Terminal Microprocessor, as 
Sewn in Figure 1.2. 

iiiememis to the Central computer (@C) are the actual and desired (future) 
position of each arm. Based on this data it calculates the best trajectory for each arm 
and sends the individual position command for the TM’s. The central computer does 
not worry about changes in the inertias or other factors that can occur in the 


individual arms. These problems are solved by the terminal microprocessors. 
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I SHE PROPOSED SYSTEM! 


A. INTRODUCTION 

The entire svstem can be separated in three different areas: model. plant and 
meormtim, as presented in Figure 1.1. However, physicaliv, there are two main parts: 
the digital microprocessor that contains the model and algorithm. and the analog 
implementation of the plant that represents the robot arm. 

fiiie “olemsvstem 1s depicted m Figure 271 and the only difference between tlus 
one and that presented in [Ref. 1] is the input of the plant. In [Ref. 1] the plant input ts 
NDOTE and here is V. This choice simplifies the hardware of the plant and still keeps 


the requirement that both model and plant have to have identical inputs. 


B. MODEL AND CONTROLLER 

The simple model that tries to approximate the plant consists of two integrators 
and a constant gain. Km. as shown in Figure 2.2. The servo mechanism with velocity 
curve following and “bang bang” amplifier that was shown in Figure 2.1 belongs to the 
controller, 

Now that the controller 1s separated from the model. let us go back to Figure 2.1 
and examine every block. The input of the regulator, R. is a step command that 
fetemmines the angular movement of the robot arm. The error. E, is the input of the 
curve . The curve approximates the deceleration curve of the motor and is a parabola. 
Mathematically, we have 

XDOT = AJ E ,whereA = K1/ 2.Km.Vsat 
Vsat= saturation limit of the amplifier 

aus, (rome servo error and the Knowledse of the system, the desired velocity , 
BOO, is computed by taking the square root of the error and multiplying by A.This 
merocity is compared with the actual velocity, CDOT, to generate the velocity error, 
memo it, that drives the amplifier (limiter). If the actual voltage, CDOT, ts less than 
Premencoretical One. NDOT, the limiter is set to + Vsat {+10 volts). that means. the 
system keeps applying “full power” to get to the desired position. The curve following 
fm@eess 1S illustrated in Figure 2.3 . When CDOT reaches XDOT the deceleration 
process starts and the limiter alternates -Vsat and + Vsat at its output in a bang bang 


process. [The gain K2 is very large to guarantee the full acceleration. 
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Figures2.2 | lhe simple model. 


C. THE PLANT 

In this research two plants were tested, a disk driver and a robot motor. The 
transfer function of the disk driver was implemented first and in order to compare with 
the results obtained in [Ref. 1] the motor and load parameters were assumed to be the 
same, that 1s, the motor of a disk driver and a very small arm. As presented in Figure 
2.1 it is a second order system with a mechanical pole at 20.55 rad.sec , a pole at the 


origin and a gain equal to 13.5. 


D. THE IDENTIFICATION ALGORITHMNI 
Pinewiaentiitcation algorithm is represented in a separate block in Figure 2.1 
because it has a specific function and “connects” plant and model. However, it is a 
piece of software included in the microprocessor and imbedded in the program Model. 
The specific function of the algorithm 1s to measure the plant output and update 
the model parameters in such a way that the model approximates the plant the best it 
can. Since both model and plant have the same input. if they have identical transfer 


functions they will have the same behavior. This is what we need because the model is 


ever 


ADO? 


CDOT IAS 
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rigupe see ure Pollen brocess: 


perfectly controllable with position and velocity feedback. Thus, controlling the model, 
the plant will be controlled. 

In an ideal case the model will be exactly the same as the plant during the entire 
trajectory. This was the case when, as an experience to observe the behavior of the 
analog plant. it was set up as a double integrator and a gain, becoming a copy of the 
model. The results were fine and will be presented itn detail in Chapter 1V) wlieresthe 
plant hardware 1s discussed. 

As menuoned in Chapter I the algorithm used in this thesis was developed by 
Wikstrom in [Ref. 1] for a disk driver svstem whose transfer function is that of the 
plant studied in Chapter 1V. Wikstrom considered two mandatory requirements to 
implement the autoadaptive algorithm: 

1. The calculations must be reasonably accurate to allow the model States to 
approximate the trajectory of the servo motor during the seek mode. The seek 
mode occurs in the full cee en phaseOl Une tralcctom: 


2. The calculations must be simple to minimize the computation time. 
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In the algorithm, the gain Km, the model output CS and the model velocity 
moO Tare updated. In the ideal model i © is the position and Vsat the saturation 


voltage of the amplifier we can write: 


Graeme (2) = Kimi = 2C V...,.07 


sat 


For a sampling interval equal to T, t = NT, where N is the number of sampling 


intervals that occured up to time t. Letting C = CS: 


ZS 


oo wee 
Veal ST) 


Km = 


he velocity of the plant can be computed as 


CSC Nel) 
T 


CSD Om 


Or, more accurately 


2CS-—CS(N-1)] 
T 
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il. SOFTWARE DESIGN sce 


A. INTRODUCTION 

As pointed out in Chapter IJ. the model is just a double integrator with a 
constant gain Km. The controller is the servo system with position and velocity 
feedback and a Velocity curve following. The block diagrain of this system is depicted 
ise voulcer2 ale. 

[In order to simplify the task for the microprocessor the amplifier was assumed to 
be just a limiter without anv linear region and the gain K2 that appears in Figure 2.1 1s 
not needed anvmore. The system will have a “bang-bang” control, that is. V will be 
+10 or -10 depending upon the valie owe Ee 

The software for this digital servo was designed following the natural sequence of 
the servo itself, from R to CM. In order to keep a uniform notation. equations Olea 
diagrams. flowcharts and programs have the same name for the corresponding 
variables. The only difference is that in flowcharts and programs the dot above the 
letter, indicating derivative, is literally written. For instance. C or CDOT represent the 
derivative of C. Another point that must be clarified is that the output of the modem 
called CM in the assembly program, rather than C, to avoid confusion with the C 
register. Thus, the derivative of CM should be CMDOT but is called CDOT (o single 
the notation. The flowcharts presented in this Chapter are directly related with the 16 
bit program “Model”, presented in Appendix A. The instructions used in the program 


are based im [ier]. 


B. MAIN PROGRAM 

The two first blocks of Figure 3.1 initialize the parallel port and soine Waridpieas 
The parallel port organizes the traffic between the discrete and continuous world 
involved in this research. The fiinction of each port will be explained in detaiaim 
Chapter IV where the hardware is presented. The variables used in the main program 
are discussed in the following paragraphs. 

The step input, R, is the position to be achieved by the robot arm. [ts value can 
be entered from the kevboard and is requested by the program. The maximum value 
allowed is 127. limited by the eight bit A D converter. CMI is the output of Tiemmmeae 


and represents its actual position. CM 1 is the position at time t munus one, that 1s, the 
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micire sl the Vian Program - Flowchart A. 


Uy) 


previous value of CM. The actual velocity of the model is CDOT. [his veloc 
fedback to be compared with NDOT as shown in Figure 2.1. CDM1 is the model 
velocity at time t minus one or the last value of CDOT. CDIDOT ismtiemaeame 
acceleration of the model. CDDMI1 1s the previous value of the acceleration. 

The output of the plant ts called CS and represents the actual position of the 
robot arm. CMCF represents the product between yi and” i9e iei ee 
correction factor used to raise the value of CM before intesration. [his wiles 
explained later in this Chapter. NDOT ts the velocity coniputed on the basis Gi same 
deceleration curve of the motor, as mentioned in Chapter I]. NDOTE is the dijjerem. 
between the desired and actual velocity of the model. KM is the motor gain. N is a 
temporary memory for the index register IY. This register points to the next position of 
the memory available for data storage and its value is copied into the memory location 
in order to check the end of memory. The memory available to store data goes from 
1600H to 23FFH. So, the storage process must finish when the most Signiticamtsaase 
of TY reaches 24H. NN counts the number of sampling intervals which have oceupem 
up to the present time and is used in the Wikstrom algorithm to compute the value of 
Kim. 

During the development of the software, all important variables were presented 
on the screen on-line. using a routine called WRITE. This routine was called after an 
Operation as, for instance, an addition, and displayed the result stored in the register 
pair HL. In this fashion, the following variables were monitored in each loop: Error, 
square root of error, NDOT. XDOTE. CDDOT, CDOT, CM and CS. [teva em 
presented on the screen in hexadecimal codes. The onlv problem with this routine is 
that more than 400 microseconds were required to display one variable and this caused 
too much delav to the program .When the analog plant 1s part of the system we cannot 
afford such delays since the continuous system does not stop working. The alternative 
solution ts to display the partial results off-line using the routine DISPLAY. But. 
before using this routine, the data must be stored in the meniory. Thus, the Tougae 
WRITE was replaced by the routine STORE. This routine takes the value ols 
variable stored in the register parr HL and stores it into the data memory (from 160017] 
tome isl 

[In some cases we do not need to store the variables in each consecutive loop but. 
for instance, store them each [ifth loop. Thus. a flag must tell the STORE Mamie 


when a data is to be stored. This is the role of ViFLAG. If MEELAG its zero the data 1s 


stored and when it is diiferent than zero no data is stored. NS 1s the variable which 
controls the number of loops that will not be displaved. When the memory is full the 
flag is disabled and no more data is stored. However, the program continues running 
Mornay. [he operation scheme of MPLAG is shown in Figure 3.2 . At the beginning 
ithe program ViFLAG is initialized to zero. So,during the first loop the data 1s stored 
Mm eroutine STORE. At the end of the loop NS is incremented and checked. Since its 
weeds not 5 yet, ViFLAG becomes FFH and no‘data is stored in the next four loops. 
imerie filth loop SS is 5 and the flag is inverted, beconung zero again and the sixth 
loop has data storage. But NS 1s set to Zero again and the process is repeated until the 
memory available for data storage is full. At this point the flag 1s converted to 55H and 
fem) tis point the inversion that occurs when NS is 5 does not convert the flag to 
wenovanyvmore. [hat is, no more data is stored. 

The main program 1s structured with many subroutines. Some of them belong to 
the monitor and will be briefly discussed here. The monitor, whose program 1s 
presented in Appendix B. is the operational system that supervises the microcomputer. 
The remaining subroutines will be discussed in the next paragraphs. 

SifewsUbromiine SmRI NG (moniter) receives characters from the keyboard and 
fageesmtiem) in a stack . The subroutine HENCONV (monitor) converts the data 
Suered in the stack from ASCII to hexadecimal and stores them into the register pair 
DE. The subroutine SCRLF (monitor) provides carriage return and line feed. 

Mieceweroutines se Bt RAG) ADDITION, MULTIPLY, DIVIDE and CURVE 
Maem performed store the result in the register pair HL. The operands must be in 
feeister pairs DE and HL before the subroutine is called. In the case of the subroutine 
ee VE (input is the position error and output is XDO1), the operand must be in HL. 
ieetne Subroutine SUBTRACTION the operand stored in DE is subtracted from the 
Seenama stored in HL. In the subroutine DIVIDE the operand stored in HL 1s divided 
eee operand stored in DE. 

mememacr tO be stored by subroutine STORE the data niust be in register pair HL. 
[iieeis very COnvenient since all operations send the result to these registers and all 
Important variables come up from some operation. 

All variables and subroutines that appear in Figure 3.1 were discussed in the 
previous paragraphs. Summarizing the operation of these first blocks : 

fee ie Parallel interface 1s set up 
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3 eee are sent to the screen introducing the system and asking for the angle 
input 


eres ss cers etic characters from the kevboard. HEACONY transtorims 
them from ASCII to hexadecimal. 


The main program continues in the flowchart of Figure 3.3. The value of the 
Input position R is saved as an hexadecimal quantity. Between this block and the next 
is located the position feedback of the servo loop. The actual position is subtracted 
from the input position and the result is stored for future presentation (off-line). 
Register C 1s set as a flag to indicate if the position error is positive or negative. The 
meemes tested. If it is negative, C is set to | amd the number is converted to positive. If 
It 1S positive, no action is taken. NDOT is computed by subroutine CURVE and the 
result is stored into the register pair HL. 

The flowehart of Figure 3.4 starts with register C being tested. [fit is zero. the 
Pmor “was Positive and no action is taken. If it ts different than zero, the error was 
meeative and NDOT is converted to negative. In both cases, XDOT is stored for 
hime presentation on the screen. The actual velocity, CDOT is subtracted from 
Pe)! resulting NDOTE. which ts stored. 

Continuing the description of the main program, the blocks of Figure 3.5 can be 
described in the following way. ADOTE, computed in the last operation is available in 
emeres value is checked. If it 1s positive, the variable V is set to + Vsat and if it is 
Mecalive, V 1s set to -Vsat and the flag KM{FLAG is set to |. The value of V 1s the 
input of the model and also the input of the analog plant and must be sent to the 
digital to analog converter. The gain Km is multiplied by V and the result 1s stored. 

The product of V and Km just computed represents the acceleration (CDDOT) 
of the model and its integration yields the velocity . Before discussing the flowchart 
that shows this computation, let us explain brieflv the trapezoidal integration used in 
Bieeprogram. Viathematically we have CDOT = CDOT + ( CDDMI1 + CDDOT ) 
T/2 ,, where the previous value of CDOT 1s added to the trapezoidal area formed by the 
actual and previous value of CDDOT and the time lapsed between them, as illustrated 
Pyerme sliided area in Figure 3.6. 

fere:y important point in the integration process is the integration step. [. it 
Peewetermuned by simply replacing the instructions “JR PLUS” and “JR VOLTS” by 
eee instructions. fhus, the +10 Volts are sent to the analog input and the time 


interval can be measured with an oscilloscope. It turned out to be 1.1 msec. 
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Figure 3.39 The Main Program - Flowchart B. 
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In Figure 3.7 the flowchart of the trapezoidal integration of the acceleration 1s 
presented and can be described as follows: The acceleration CDDOT . just computed, 
is saved. The previous value of CDDOT is loaded into the register pair DE and the 
actual value of CDDOT is stored in CDDM1, that is. CDDM1 is updated. The actual 
and previous value of the acceleration are added. The register pair DE receives T1 = 
2/T. This transformation is necessary because T is a very small value and cannot be 
represented by a 16 bit integer number. So, instead of a multiplication by T’2, we can 
Beige Gy 2;) — Tl. The sum, CDDOT + CDDM1. is divided by Tl. The last value 
mei)? is added to the above result vielding: CDOT + ( CDDOT + CDDM]1)T 2 
The actual value of CDOT 1s saved and stored for posterior presentation. This 
integration was first designed as a 16 bit computation and then modified to a 32 bit 
floating point program. The actual and previous value of the acceleration (CDDOT 
and CDDM1) are kept as 16 bit variables and the 32 bit value of CDOT is saved m 
Memaporary Variables to be used in the next step. CDOT is also saved as a 16 bit 
Sieber to be displayed on the screen. 

The conversions from integer to floating point and vice-versa are not detailed in 
Peemiiowchart but each number that goes to the Arithmetic Processing Unit 1s 
converted to a 32 bit floating point number before the operation. 

The integration of CDOT just computed gives the actual value of the position, 
CM. However, there is a computational problem due to the fact that the integration 
meepeis ver. Small. Since the first values of CDOT are also small and the computer 1s 
working with integer variables, all values of CM that are less than one are rounded to 
zero and not accumulated by the trapezoidal integration: 

ob ey) - (eWOT-+ CDM]) 1/2 

eeecom) be seen from the above equation, as far as the second term (CDOT + 
meee 2 is zero (or rounded to zero) the value of CM will stay at zero. The way to 
bypass this problem was to magnify the value of the variable to be integrated (CDOT) 
multiplying it by an amplifier factor before the integration. After the integration the 
Output is attenuated by the same factor. As shown in Figure 3.8 the corrector factor 
(CF) was set up to 100 and the output of the integrating block is CMCF that stands 
for CM times CF. This was the first approach to compute CM and could be modified 
tO Work with 32 bit floating point numbers as in the CDOT computation. However, 
CM is being updated everv loop and the result of this computation is not taken into 
account. [f this is not the case, the integration instructions can be easilv modified bv 


looking at the CDOT computation. 
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3.4 The Main Program Flowchart C. 


icine 


With this introduction to the integration of the velocity the flowchart presented 
in Figure 3.9 is easily understood. This flowchart is a continuation of that studied in 
Figure 3.7 where CDOT was computed and loaded into the HL register. The tast value 
mimeo) (CM Vi1) is loaded into the register pair DE and the actual value of CDOT 
meeeies Cl) vil for the next joop. CDOT (in HL) and CDM! (in DE) are added. The 
meister pair DE is loaded with TIOCF that stands for Tl over CF. This parameter is 
@reated by the fact that. as mentioned in the first integration. T1 = 2;!1 and the 
corrector factor multiplies the input variables. The division rather than multiplication 
was explained in the last flowchart. The last value of CMCF is toaded into DE and 
meedewith (CDOl + CDOMI)(T,2)CF yielding the new value of CMICF. CMCF is 
saved, DE is loaded with CF and after the division the new value of CMI 1s obtained. 
paanis CV = CVICF CFE. 

The main program continues in the flowcharts presented in Figures 3.10 and 3.11 
The idea behind this section of the program. is to get the plant output and, using the 
Wikstrom algorithm, update the parameters of the model. Since these two flowcharts 
are at the end of the main program thev also test the variables that control the end of 
the memory available for data storage and the frequency of storage . The flowcharts 
can be described as follows. CM, the actual model output just computed, is saved for 
future calculations and stored for off-hne presentation. The subroutine ANALOG 
loads the plant output into the register pair HL and the subroutine STORE saves it at 
the data memory. The subroutine WALG applies the Wikstrom algorithm to update 
Km and CM based upon the actual and previous plant outputs. 

meice vatiable NS, whoSe {UnctiOn if to control the frequency of storage, 15 
Meememented and checked. In the example presented in the flowchart the desired 
frequency of storage is 5. This means that the data are to be storage every five loops. 
As explained before during the discussion of the MMFLAG scheme, if NS = 5, MFLAG 
is coniplemented and becomes zero, enabling the storage process and NS 1s set to zero 
Memmestart the procedure. On the other hand. if NS is not zero MFLAG is set to FFH, 
@ieaoume the storage process. The data memory is checked. If it is fult \IFLAG is set 
feet, and from this point no more data is stored, since the complement of 55H is 
Pee and \iFLAG will never be zero again. If the memory 1s not full, no action is 


taken. In both cases the program is addressed to the beginning to close the loop. 
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Figure 3.6 Trapezoidal Integration. 


mr SUBROUTINES 

Mes man programy NIODEL” was structured to be easily understood and 
followed. Since it is written in Assembly language some simple operations need lots of 
Instructions. In order to overcome this problem, all repetitive operations were 
implemented in subroutines. 

Each time a subroutine 1s invoked, 13.5 microseconds are added to the program: 
Beemcmie (oO the instruction “C-\LL” and 5 nucroseconds due to the instruction “RET”. 
Bamtme Present program. there are 38 calls to subroutines vielding a total time of 513 
Mmeroseconds. [his reasonable “delav’ 1s not affecting this experiment but could affect 
Meeractical application. Hlowever, if necessary, this time can be reduced to zero bv just 


imbedding all the subroutines into the main program. 
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Fig@iire 3.S Velocity Intéeration using the Corrector Factor. 


I. The Subroutine ANALOG 

Mijesemrective ol this Subrautmes te=sample the plani output, CS, at the end 
of each loop. This is done through port B of the parallel interface and the analog to 
Seeaeconverter (ADC). Port B of the interface is at address 0211 as determined at the 
beginning of the main program. 

Some of the instructions presented in this subroutine need a little knowledge 
mere hardware to be completely understood. However, the main idea can be abserbed 
Mom the flowchart presented in Figure 3.12 The blocks are now described in the 
sequence they appear in the flowchart. The ADC ts enabled and starts converting the 
actual analog output to a corresponding cight bit number. The DATA READY pin of 
the ADC is polled and if data is available (conversion is completed), it is transferred to 
Sgew recisier. Othervise the status is checked again. The incomung data is converted 
In a two's complement number by adding SOFI. This is explained in detail in Chapter 
IV. 

. Pier cOmversion in a two s complement numiber the data sign ts checked. [fit 
eeeeative a CONnVersion to positive 1s executed. [he reason to justify this procedure 1s 
@ume@rsimple. In this research the movement of the robot arm is restricted to just one 


Mimeeton and negative numbers are not expected. However, at the beginning of the 
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movement, when CS is still a very small number the noise can drive the output to a 
negative value and this would introduce an error in the system, since the program 1s 
not prepared to deal with negative numbers comung from the analog plant. Since the 
data is equal to or less than 127 and a positive number, it 1s loaded into register L and 
register H is set to zero. The ADC is disabled to allow the repetition of the process. 
Mais step will be detailed im Chapter fV. 
2. The Subroutines of Basic Operations 
The subroutines that perform addition, subtraction, multiplication and division 
will be called basic operations subroutines. They all use the Arithmetic Processing L nit 
eee ye intelo23! to perform the operations. [he procedure is the same for these 
subroutines as shown in Figure 3.13 . The operands are sent to the APU by subroutine 
OUTOP. Then the appropriate command (each operation has its particular code) tells 
GgeeePU what operation is to be performed with those operands. Finally, the 
subroutine INOP (input operand) retrieves the result from the APU. In all talks 
between APL and microprocessor the operands and commands must pass through 
register A of the CPL. The APU operands and commands are addressed to outputs 
OSH and O9H, respectively. An important point to be noticed in the program 1s that 
the operands must be loaded in register pairs HL and DE before calling a basic 
Peeration subroutine. In order to get correct results in the subtraction and division 
subroutines we have to keep in mind that the registers will be manipulated in the 
following way: 
Subtraction is given by HL — HL — DE 
Division 1s given by HL « HL;/DE 
5. The Subroutines OUTOP and INOP 
As mentioned above the subroutines OUTOP and INOP communicate with 
the arithmetic processing unit in order to send operands before an operation and 
Meugeve the result after the operation. The flowchart of the subroutine OLTOP is 
shown in Figure 3.14. The contents of the registers HL and DE are sent to the APU in 
this order. Also notice that the low bytes are sent first in both cases. The subroutine 
ieee is presented in Figure 3.15 The result obtained in the APU after an operation is 
transfered to register A and then to registers H and L. in this order, one byte at a time. 


Notice that the high order byte of the sixteen bit result is the first to be retrieved. 
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4. The Subroutine CURVE 

This subroutine uses the APU to compute NDOT from the positionverromane 
the constant SQRT(2.V.,,.Xm). The computation is all done inside the processing unit 
to avoid the error caused by converting tne square root to an integer. Every variable or 
constant that is sent to the APL is converted to a 32 bit floating point number. After 
the computation XDOT is converted back to inteser (rere temic ten toe 

5. The Subroutine WALG 

This subroutine implements the autoadaptive algorithm described in [Ref. 1]. 
In that algorithm. the position, velocity and gain of the model are updated. However, 
the velocity CDOT is not being updated in this subroutine. for the following reason: 
the program was written for 16 bits but the interfaces were built to work with just eight 
bits, in order to simplify the plant. So. the biggest positive number the plant can deal 
with 1s 127 and the smallesz is [. 

AS a consequence of the above restrictions, the diflerences between an vaccum 
value of the plant output (CS) and its last value can not be alwavs detected due to the 
round off problem. Since the computation of CDOT is based upon this difference, the 
result would be wrong most of the time. For instance, lets consider that thewenaaen 
value of CS is 54.82 and the last value of the plant output (CSIVPL) was Soeaiee 
Assuming that the velocity 1s computed using the simple formula CSDOT=(CS- 
CSM 1)/T and working with integers the result will be CSDOT=0. since CS and CSM 1 
were both rounded to 54. 

The flowchart of this subroutine is presented in Figure 3.17 anaeaieiee 
described in the following paragraphs. All the operations are done using the Arithmetic 
Processing Limit and intecer munibers( 16: bins: 

The variable KMFLAG is set to zero at the beginning of the main program 
and when the full acceleration phase ends. that is CDOT is greater than XDOT Tor tie 
first time, it is set to I. In the subroutine, the flag is checked and if it is one) A visiseee 
computed anymore, remaining with its last value. 

In the full acceleration phase KM is computed and updated each tume the 
subroutine is called. The formula used to compute AM is the following: 

KM = 2CS Vsat(NT)-. 
The values of Vsat and T are known and representing the constants bv the paranicter 
Reve wowace: 
KMC = 2 10Vsat(T)- = 16529 for T = 1.1 ms and Vsat = 10. 
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The extra constant in the denominator (10) was introduced because the numbers 
Samo. Oe reater than 32767. So, after the division by N (represented by NN in the 
program) and the multiplication by CS. KMC must be multiplied by 10. This 1s shown 
in the eight blocks that follow the KMFLAG block ending with KM being updated. 
ie reason K VIC is not divided by NN? first (saving instructions) and then multiplied 
yees and 10 is that when NN becomes a big number and KMC/NN2 becomes less 
iWaameone it is rounded to zero. So, after the first division (KIC; NN), there is a 
multiplication by CS to raise the result before dividing by NN again. 

6. The Subroutine STORE 

mis sabroutime transiers the data irom register pair TIL to the data memory. 
The purpose of this storage is to make those data available for an off-line presentation 
on the screen. As mentioned in the previous subroutines all operations send the result 
Bemeresister pair HL. So, this routine is always called after some important 
operation. The flowchart is presented in Figure 3.18 and can be described as follows: 
The tlag is checked and if it is zero the data is loaded into the memorv and the pointer 
is incremented. Otherwise, no action is taken. 

7. The Subroutine DISPLAY 

The main purpose of this subroutine is the off-line presentation of the data 
Memeaoy subroutine STORE on the screen off-line. That is, after the complete 
displacement of the robot arm, the program can be reset and the intermediate steps can 
be analvzed by calling the subroutine DISPLAY. The operation procedure 1s discussed 
in Appendix C. The variables that are set up to be stored by the actual program are: E, 
meet, XSDOTE, CODOT, CDOT, CM, CS and NN (the number of loops). Thev are 
stored from address 1600H to 23FFH, with a total of 3584 bytes. Since each variable 
has 16 bits and eight variables are stored each loop, the memory is able to store 224 
loops of the main program. If the data are stored in consecutive loops. only the first 
246 nulliseconds of data will be stored. If alt the loops are not stored this time can be 
Inereased. for instance, if the data are stored everv fifth loop the program will be 
documented for 1.23 sec. The number of loops to be stored can be changed if the 
program is transferred to the RAM (refer to Appendix C). 

Another important feature of this subroutine is the conversion from 
hexadecimal to decimal before displaying the numbers on the screen. This would be 
impossible to iunplement on line due to the amount of time required to implement this 


coniplex operation. The data is displaved in eight columns, ten rows at a time, and thev 


can be scrolled up by pressing the space bar or any other key. The number of rows to 
be presented at a time can be changed if the program is transfered to the RAM. 

The flowchart of the DISPLAY routine is presented in Figures 3-19a thromam 
3.19e. The blocks can be described as follows. the memory pointer index LY ts loaded 
with the first data address, 1GOOH. N is loaded with the number of rows (or loops) to 
be displaved (224) and N=0 indicates the end of memory. NS controls the number of 
rows to be displaved at a time. After the initialization process the loop is started by 
loading the first data (the position error of the first loop) into the register pair HL. 
The data is checked. If it is positive a space is displayed on the screen anduiieiieee 
negative a munus sign is displayed. The data is saved in a variable called NUMBER 
and the register pair DE 1s loaded with the decimal 10. The data (in HL) ts divided by 
10 (in DE) and the quotient (in FIL) is saved ny the variaplien@ ee 

The quotient (in HL) is multiplied by 10 (in DE). The result is transterreqmas 
DE and the data that was saved in NUMBER 1s loaded into HL. So, recalling thames 
subtraction does: 

HL =H previonsa ee 
and after this operation HL will be equal to the least significant bit of the decimal 
data. This value is saved in the variable ONES. Thus, 
ONES = dividend (data) = IDO0 ew 

The LONGDIYV subroutine .presented in Figure 3.20 uses the same procedtime 
mentioned above with the actual quotient being the dividend of the next division. [The 
new renunder will be the second decimal digit (saved in the variable TENS) ee 
process is repeated to get the next digits, saved in HU NOREDS) DH@@ aa 
TIHOUS: The biggest possiGle décimaliumber 1s ore 

The decimal digits are converted to ASCII and displayed on the screen using 
the monitor subroutine ASCONV (refer to Appendix C). After the presentation of the 
least significant digit. register B is loaded with the number two and the monitor 
subroutine SPACES is called to display two spaces between the number just shown and 
ule ext 

Every time a conversion is completed the pointer is checked to verily iieGae 
row ended. At the end of the first row. for instance. the pointer (1 Y) will be oie 
that is, the rightmost four digits are zero. The same happens every time a row Is 
conipleted since eight two byte variables make a comiplete row. Thus. if this situation 1s 


detected, meaning that a row is conipleted, the monitor subroutine SCRLUP 1s callegams 


provide carriage return and line feed. Otherwise, a new data is converted. The loop 
continues until the end of the row. 

Whenever a row is completed the end of memory must be checked. As 
mentioned earlier the number of rows left is controlled by the variable N. So, each time 
a row 1s completed. N is decremented and checked. If it ts zero the program is ended, 
otherwise it continues. 

The program 1S set up to present 10 rows at a time. The variable NS counts 
Piesnumber Of rows and while NS is different of 10 the loop continues. When NS 
reaches 10 the program polls the kevboard input. While there 1s no input the program 
Keeps polling the keyboard. When anv key is typed, NS is set to zero and the loop 
continues. 

8. The Subroutine TRANSFER 

This subroutine is used to transfer the program MODEL from the EPROM to 
the RAM in order to debug the program. The starting address in the RAM is 1000H. 
The procedure to use this feature will be discussed in Appendix C. The subroutine is 


very simple and can be understood from the program. 
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IV. HARDWARE 


pee GENERAL 

The hardware consists basically of two major parts, the microprocessor and the 
analog plant. Interconnecting them we have the digital to analog and analog to digital 
interfaces. A video terminal is coupled to the microprocessor and all inputs and 
Outputs are accessed by using this facility. An oscilloscope connected to the output of 
the plant measures the analog output. This voltage is also available in a digital form 
Meme (Olt-line) the routine Display. The whole hardware is mounted in three 
protoboards, one for the microprocessor, one for the analog plant and a third one for 


the extra memories used to store data. 


poe HE MICROPROCESSOR 

Sic alereprocessor 1s 4 general term used to refer to the digital svstem that 
implements the model, controller and the identification algorithm. The circuit that 
shows all the digital svstem and interfaces is presented in Figure 4.1. 

The central processing unit is the Z-80, the memories are two EPROMS (2716) 
and five RAM’s (A{K 4118). The memory and interface decoders are three 74LS138. 
The parallel interface is the M8255 and the serial interface is the MC68661. Besides 
the mentioned chips that are normally found in microprocessors there is the Anthmeuc 
Processing Unit (APL), Intel $251, that performs all the mathematical operations 
needed in the digital svstem. 

iii Orsanization of the memories is shown in Table 1 . The monitor and model 
(including the controller and algorithm) are loaded into the EPROM’s. The RAM 
addresses from 1000H to 13A0H are used for scratch. This is an important point in the 
development of the system because it allows the whole program “Model” to be 
tansiered from a non-crasable memory to an erasable one. Once the program 1s 
transiered it can be modified and run in the RAM using the monitor features for 
debugging purposes. This procedure will be detailed in Appendix C. 

Bence sw eaddresses from I3A0F to 1G00H are used to store the data segment. 
that 1s, all variables defined in the monitor and program Model. Also. every bvte 
S@ieinated by typing a kev in the kevboard goes to a particular stack in this memory 


Meee he microprocessor stack pointer is initialized at 1G0QH. 
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TABLE 1 
MIEMWIORY ORGANIZATION 


27 | START END | TYPE | FUNCTION 
m2) OOCO O75 EPR@Mie2 /ak6 monitor + model 


m2! os00 =— ||—=s—s<OF FE CO EPRol 276 Medel. (Cont. ) 

RAM MK4118 | scratch/data seg 

M4) 1400 TEE RAM MK4118 data seg/storage 
i : 


M7| 2000 23FF | RAM MK4118 data storage | 


The memory fron 1600H to 23FFH is the so called “data memorv”. It stores the 
intermediate results of program Model for future presentation on the screen. After a 
run the subroutine Display can be invoked to show these data. The RAM memories 
yee 5, ViG and M7 (refer to Figure 4.1). used for data storage. were created to allow 
the off-line display of the mentioned data. When the digital servo was first tested 
(without the analog plant) it used on-line routines to show the results on the screen. 
However, each time the routine was called to present one variable it spent more than 
400 microseconds. This would consist in a major problem for incorporating the analog 
plant. So, the extra memories were added to the system in order to provide room for 
the massive data record generated by the subroutine Store. 

As shown in the circuit, the decoder D! addresses the EPROM’s M1 and M2 and 
the RAM M7. The decoder D2 addresses the serial and parallel interfaces and the 
APU. Decoder D3 addresses the data memories V[3, M4, M5 and M6. 

Decoder D2 is selected by addresses A2. A3 and A4 and its outputs YO (pin 15). 
Seep !4) and Y2 (pin [3) are the chip select conumands for the $255 (parallel port). 
68661 (serial port) and APU, respectively. So, depending on the addresses Al and AQ, 
the parallel interface will be at addresses 00, O1, U2 and 03 and the serial interface will 
be at addresses 04, 05, 06 and 07. The APU will be at addresses 08. 09, O-\ and OB. 


Beet iiE ARITTHNIETIC PROCESSING UNIT 
This integrated circuit deserves a special attention in this research. First of all, it 


played a very important role on the software development in taking over all of the 


tan 
Cn 


mathematical operations. Secondly, it 1s a preliminary chip and its application consists 
in a parallel research. 

The Arithmetic Processing Unit (APL) $8231, as referred in [Rei 3) iqseemes 
following features: 


{. Fixed point, single and double precision (1Gto api 


tr 


Floating point single precision (32 bits). 


Binary data formats. 


oY 


Add, subtract, multiply and divide. 

Trigonometric and inverse trigonometric functions. 
Square roots. logarithms, exponentiation. 

Float to fix and fix to float conversions. 

Stack oriented operand storage. 


Direct memory access or programmed [,O data transfer. 


ee ee ees 


General purpose § bits data bus interface. 

In the 16 bit program this chip is used to perform the following operations: 
addition, subtraction, multiplication, division, square root, fix to floating point 
conversion and vice versa. In general the operations were done with fixed point 
Operands to keep the program working with 16 bit variables. However, some 
operations Where the APU stack could be used as a temporary register, were donemimmes 
bit floating point. This happened in the subroutine CURVE and in the trapezoidal 
integration in the main program. The advantage of this method is that the accuracy of 
the computations is increased without defining 32 bit variables. 

The 16 bit format is straight forward. [t works with binary operands represented 
in two's complement values. The sign of the operand is located in the most significant 
bit (at the leftmost position). Positive values are represented by zero and negative 
values are represented by one. This format can represent numbers in the range from 
= 16S (6 shor. 

The 32 bit floating point format permits us to represent positive and negative 
numbers from 2.7 x 10°29 to 9.2 x 1048 and zero. As depicted in Figure 4.2); themem 
bit numbers consist of four parts: mantissa, exponent. exponent signal and mantissa 
signal. The mantissa uses the 24 rightmost bits (0-23), the exponent uses the next six 
bits (24-29), the exponent sign uses the next bit (bit 30) and the mantissa sign 1s 


represented at the leftmost bit (bit 31). 


exponent mantissa 





Figure 4.2 32 Bit Floating Point Register. 


A requirement of this processor is that the data, when using 32 bit floating point 
format, be represented by a fractional mantissa value between 0.5 and 1.0 multiplied by 
two raised to an appropriate power, that is, value = manussa X pe Pen 

Illustrating the explanation above with an example, let's take the number 624 
and convert it to 32 bit floating point: 

624 = 512 + 64 + 32 + 16 = 27 + 29+ 24+ 2 = 
= 0.1 x 219 + 0.0001 x 2! + 0.00001 x 2!9 + 0.000001 x 2!9 = 
= 219 x (9. 100111) 

ice binary Tepresemiation of the above example is shown in Figure 4.3 . The 
hexadecimal representation of this four byte number is OA9COOOOH. This is the code 
Bemoe sent to the APL im order to create the floating point equivalent to the decimal 
624. 

The APU uses a stack to store the operands and results. It is an eight level 16 bit 
wyide data stack. as shown in Figure 4.4 . The same stack is used to deal with 32 bits 
imiieit’ this case, the configuration changes to a four level stack. The upper level is 
Blea) OS (top of stack) and the level below the TOS is called NOS (next on stack). 

Data are written onto the stack, eight bits at a time in the order Al, A2, A3, etc, 
Meera removed in the reverse order. For instance, suppose the operation B ~A = C, 
eer > — BO Bl. A = A2 Al and C = C2 Cl. In a subtraction the operand in the 
fee eoms suctracted from the operand in the NOS and the result is stored onto the TOS. 


ieoise the bytes must be sent in the following order: BI, B2, Al. A2. The result is 


af 


exponent mantissa 





Figure 4.3 Example of a 32 Bit Floating Point Number. 
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Ficure 4.4 Stack Configuration tor 4) Gamo 


retrieved in the order C2, Cl. Considering the wav the software was desiemeqaaaee 


operand B would be onto the register pair HL and the operand A onto the registeroas 


Pie iiemresuit would ee im Gils so, the Gata from the registers would be sent to the 
eemimcnelelewmime order MH. &. and the resuit would be received in the order 
ale L. 

The data entrv and data removal process 1s illustrated in Table 2. Data entrv 1s 
accomphshed by bringing the cnip select (CS), the conimand, data line (AQ) and the 
Paie line (WR) low. A new entry occupies the TOS, pushing the previous TOS to 
BOs, Mata renioval is performed by setting CS. AO and RD tow. The data in TOS is 
removed and the data in NOS is moved to TOS. 


TABLE 2 
DATA ENTRY AND DATA REMOVAL PROCESS 


WR | RD | CS | AO | OPERATION INSTRUCTION 


I ay tom 
oe i 0 | 0 | write OUT (08H),A 
0 | 2 | Command | OUT (09H),A 


| 1 0 o | 1 | Read Status | IN A,(09H) | 


Puroreiierdala Nave been entered the required operation can be performed by 
issuing a command. The command operation is accomphshed by bringing the chip 
select hne low, conimand, data line high and write line low. 

It can be seen in Figure 4.1 that the READY line of the APU (pin 17) is 
connected to the WAIT hne of the CPU (Z-80). The READY line is normally high and 
is pulled low by the APU when certain conditions occur. Basically, the READY line 
goes low when the APU 1s busy and either data or command operation is requested. If 
this happens, the WAIT line of the CPU goes low and it waits. When the operation is 
Memagicted the READY line goes high and the result is available at the TOS. Then the 
fr eecan retrieve the data from the APL. The process of removing data is illustrated in 
eg@entirst row of Table 2. 

The software for the the APU ts quite simple and can be easily understood from 
the. program. However, in order to figure out how the operations work and to have a 
complete knowledge of the chip. some small routines were written to test individual 
Operations. These routines were written in machine language using the features 


available in the monitor. 


As pointed out earher in this Chapter, the memory addresses from i3A0H to 
16Q00H are used for the data segment. that is, to store the variables used in the 
program. But this sectton of memory is not completely filled and there is some space 
available. The test program can start at address ISAOH, for instance. The sequence to 
Write the program is the following: 

1. Turn on the svstem (video ternunals and power supphes). 
2. Reset the system by pressing the reset switch. 


3. In the Kevboard. tvpe: CI5A0.xxxx <ret>.. This will be the Secinienmuem 
memory to be used (XxXxx 1s the end address of the small program). 


4. Type in the machine language program. entering one byte at a time. that 1s, 
type two hexadecimal nunibers and hit the return key. 


The procedure to run the routines and get the results is as follows: 


1. Type GI5A0,vwvv <ret>, where vyvy is the end address plus one Gigtne 
routine, that 18, VW¥y 1s equal to XXXX + 


2. When the execution is completed the registers will be automatically displaved 
on the screen and the result of the operation under test will be Shown: ieee 
heersvel aid ix 

1. Subtraction Routine 
The APL performs NOS — TOS and stores the result onto the TOSsaiime 
result is removed from the TOS and stored into the register pair [1L. where it Camis 
checked after the execution of the routine. In the example shown in Table 3eime 
operands are 0002 (TOS) and 0007 (NOS). So, the expected result 1s QU0339@titey 
examples can be done bv just changing the operands. In this particular example the 
last address 1s ISB9H and the execution command should be: GiSA0 1ISBA = Ten 
With this command the program will run and the CPU registers will be displayed on 
the Screen: 
2. Multiply Routine 
The APU performs NOS X TOS and stores the result onto the POssaaie 
result is removed from TOS and stored in HL where it can he checked altenaaae 
execution. The routine is presented in Table 4 using the operands: FFFAH = —6 and 
OOOIH = i. Thus, the expected result is FFFAH = —6. Other operands welemiaes 
to check the routine: FFFAH = —6 as first and second operand with result O0Q4H = 
26 and FFFAH = —6 and OO02H = 2with cesuli i] ces 
3. Square Root Routine 
This routine is performed using 32 bit (floating point) format. Therefore, the 


16 bit integer operands must be converted to floating point and the result. converted 
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TABLE 3 
SUPGRACTION ROUTINE FOR TESTING THE APU 


Seeuely Machine | 
ancguage Address Language Comments 

LD  A,O7H 15A0 3E07 |APU <-- first operand | 
OUT (0O8H),A 1328 | D308 | 

A, 00H 15A4 3E00 | 

OUT (08H),A 15A6 | D308 | | 
LD A,O2H | 15A8 ea02 APU <-- second operand 
OUT (08H),A | iSAA D308 

LD A,OOH ioe eS t—ET 
OUT (O8H),A | 15AE | D308 | 


A,6DH 15BO 3E6D — <== subtraction 
@OT (09H),A 15B2 D309 


A,( 08H) 15B4 DBOS result 





A, a, 15B7 DBOS 





back to integer. In the example shown in Table 5 the operand is 0270H = 624 and the 
@repectec result is ISH = 24, that is, the square root is rounded off to the next less 
integer. AAs in the previous routines the result can be checked at the HL register after 
@eeecution, Since the start address is 1SAOH and the end address is 15BYLI, the 


eeecution command will be: GISA0.1ISBA <ret>. 


Dee THE INTERFACES 

The serial and parallel interfaces, MC6S80661 and $255, respectively. are largelv 
used with eight bit microprocessors and will have just a short explanation. The serial 
interface interchanges information with the video terminal. So, all the commands 
conung from the terminal keyboard and all information going to the screen are 
formatted by this chip. The parallel interface connects the microprocessor with the 
analog plant. So, the plant input (V) and the plant output (CS) pass through this 
interface, in digital format. As shown in Figure 4.{ the three ports available in the 


$255 are used in the following way: 
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TABLE 4 
MULTIPLICATION ROLTINE FORSTES RESG Tees 


: ee re | Machine . 
anguage | Address Language Comments 
OUT (08H),A | 15A2 D308 | 
LD A,FFE | 15A4 #+| 3EFF 


: | 
| OUT (O8H),A | 1546 | »p308 | 





! 


















BD aC ae | 15A8 Sned | APU<--second operand | 
| OUT (08H),A | 153A D308 
| LD A,OOH | 15ac 3E00 
LD A, 6EH 15BO SESE APU<--mult. command 
our (09H),A | 1532 | vsoo | |) 
| IN A,(O08H) | 1534 ! DBOS | HL<--result from APU | 
' LD #,A | 15B6 | 67 | | 





IN 3A,(O8H) | 15B7 |  DBOS 


i bobby provides the digital output (V) to the digital to analog converter (DAC 


tr 


Port B receives digital input (CS) from the analog to digital converter (AD3/0) 


Port C is used to control the AD converter 


3 


The digital to analog converter (refer to Figure 4.5) is always converting the 
digital input to a continuous voltage output between pins 2 and 4. The reference 
voltages, applied at pins 14 and [5 are +5 V and —5 Vj respectively” [he resicuem 
connected to these terminals are called pelerence Tesicaams 

The full scale output current (Ip), represented by the sum of the currents at pins 
2 and 4, is related to the reference voltages and resistors in the following way: 

ete 
lr = Ig + To 
V cap oe ee SS) = 10 sees 


-R..) xaeel rae 
ref at (255 20) 
lc 


TBs S 
Peer Ow ROUTINE POR TESTING THE APL 


Assembly Machine | 


Language Address Language Comments 

3E70 |APU <-- operand 
OUT (O8H),A 15A2 p308_—Cés! | 
LD A,O2H | 15084 | 302 
OUT (08H),A | 15a6 | D308 | ! 
LD A,1DH | 41588 | 3E1D  |int./float command| 
OUT (0O9H),A | 15AA D309 


LD A,O1H 15AC ea boc) hoor “command 


oe Plone ac. “Command 

OUT (09H),A 15B2 D309—CédY | 
| IN A,(O08H) | 1534 | DBOS HL <-- result 
LD 4H,A | 1556 | 67 


mr A,(08H) | 1537 DBOS 



















In full scale, that is, with all digital inputs equal to 1, the current [py is 2 mA and 
ire current Io ieoemO Cetleo ¥ al the operational amplifier output, R2 must be 2.5 
ieee im zero scale, that is, with all TTL inputs equal to 0. ij. = O auGe ly = 2 mA. 
isto Obtain —35 V at the output R1 must also be 2.5 K&2 . In the actual design. 
the plant is being driven by an input of +10 Volts and the resistors are both 5KQ . 

eile. OG located at the plant output. the input can vary from — 3 V to +5 
V, providing digital outputs from OOH to FFH. respectively. This is not compatible 
with the two's complement format of the microprocessor, where OOF! corresponds to 0 
Meer rl Corresponds to — 1. In order to correct this discrepancy, every time a 
number comes from the ADC, the program adds SOtI. The effect of this correction is 
iliustrated in Table 6 . Looking at the Table one can sce that a difference of | inside 
the microprocessor corresponds to a difference of 0.039 volts in the analog plant (5 
volts’2/) because we are dealing with eight bit numbers. There is a difference of SOH 


between the second and third columns, that is, between the binary numbers at the 
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Figure 4.5 Digital to Anaiog Converter. 


interfaces and the two's complement numbers inside the mucroprocessor. This is the 
reason Why the software adds 80H when a number is received from the ADC (tcl 
subroutine Analog in Chapter II]). 

In the case of the “bang-bang” input of the plant (=10 Volts) the software sends 
QOH or FFFI directly to the DAC and there ts no problemy with conversiea: 

Tne anatog to digital converter, AD570, receives the analog output oO] theveiamm 
(CS) and convert it to an eight bit number. As shown in Figure 4.1 the output of the 
ADC is connected with port B (pins IS through 25) of the parallel interlacaiiaas aes 
Port C of $255 (pins 10 and 17) is used to contro! the sampling process” \ aemeamme 
BLANK and CONVERT input (pin 17) of the ADC goes low the conversion is stantem 
Lon completion of the conversion the DATA READY terminal (pin 11) goes low and 
the data is available at the output. The BLANK and CONVERT input must become 
high again to prepare the device for the next conversion. Thus, the software jiceues 
control these two lines to get the data at the appropriate time. 

Table 6 can be used to relate the data inside of the mucro and at thew wiee 


output. The two converters must be adjusted to have the same correspondence pelcam 


64 


Avie 
Pee eee hie OUTSIDE THE \IICROPROCESSOR 


Analog | ADC imemeemviicro (2's compl. ) 


(volts) | Binary | Binary Hex Decimal 

+4, 96 ied 141 Oe | 75 #127 | 
+#0.39 | 10001010 | 00001010 | oa +10. 
+0.039 IsooO0C1 J eeoeoce1 | O1 | +1 | 


0 | 10000000 00000000 | 00 0 











oe O39 OIE ae aEn eae 
00001010 


OO000000 


Aaya 3 
VEOO TOTO 
LOOOOQO0O0O 


-1 













the numbers since the whole system must be compatible. In order to guarantee that 
DAC and ADC are tuned. some simple tests Were done. One test consists in applving a 
DC voltage at the ADC input and send this voltage to the DAC output using a small 
program. This prograin is written in machine language and can be loaded into the 
RAM, using the monitor. An example is presented in Table 7 . The voltage measured 
at the analog output (V) niuust be the same as that applied at the analog input (CS), if 
the resistors in the operational amplifier are equal to 2.5K2 . This voltage can be 
varied and observed at the plant input (V). 

The small program is executed with the command G15B0.FFFF<ret>. This 
command guarantees that the last address is included and the prograni will be in loop. 
The second address in the conimand could be anyone greater than 15C9. Some lines of 
this routine need more explanation: 

Meeines | and 2 set uc the $255 to transnut cata through ports A and C and 
receive data in port B. In other words, ports A and C are outputs and port B is 


input. 


een lines > and 4 a Zero is sent to port_C (PC7 or pin 17), in order to drive the 
BLANK CONVERT control of the ADC to low, enabling the conversion. 


iene Ss the DATA READY pin is checked to verify if the data is already 
converted. If it is not. the polling process continues in the loop described in 
lines 5,6 and 7. 


tad 


=, {n line S the data is retrieved from port B and in line 9 thev are sent to port A. 
mhere the DAC is connected. 


> im line Il. port C receives SOH. That means. pin PC7 receives 0, disabling the 
conversion and preparing the ADC for the next one. 


TABUER 
COMPATIBILITY TEST BETWEEN ADC AND DAC 


Assembly Mach. | 
Languace | Comments | Address Langa 















15B4 | 3E00 
15B6 (D302 
is3ss \Dsee 













| 10| LD A,80H_ | A<-- 80H isc3 |3neOumm 


iplek| OUT (02H),A! disable ADC | 15¢S  |DacoumE 
| 


12 | JP LOOP \ meapeat erecese Lee 1C3B415) 





Ek. THE PEANT 

The plant is represented by an analog simulator as depicted in Figure 4.7 . The 
input of the plant is a “bang bang” control voltage. The output 1s a voltage that 
represents the robot arm position. CS. The input V comes from the DAC as discussed 


sat Of ~ Year 
The design of the analog plant is straight forward and the method is found in 


ithe last section.ang Caalbe = (= 10 Volts in ouriea 
most of the classical control books. The approach chosen is based in [Ref. 3]. As 
shown in Figure 4.6 the plant transfer function can separated in two blocks. 


Mathematically we have: 


—— = ————— > Nis\(s+20.55)= U(s) 
LG ease 





sX(s) + 20.55X(s) = U(s) > x+20.55x = u. 


Then. x = u= 20.55x and y= "273.3 ae. 
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Figure 4.6 Plant Transfer Function. 


The above equations provide all the information needed to implement the 
hardware. If x is assumed to be available (refer to Figure 4.7), the next step is to design 
an integrator to obtain x. Using a capacitor of IF and a resistor of 1MQ2 the output 
of the integrator will be —x. The 10 KQ2Q potenciometers that appear in all operational 
amplifiers are used for off-set adjustments. 

Since —x and V are available, a summer with a gain of 20.55 for —x and 1 for V 
vields —x at the output. An inverter changes the sign of —x and the result is the x 
needed for the feedback to the starting point. The output y or CS is obtained from —x 
by integrating this variable with gain 273.3. 

The design of the plant was quite simple, but the implementation needed special 
attention. If the components are just put together without any care the result is 
catastrophic. Oscillations and drifts are the common problems. In the particular case of 
the integrators the critical points are the capacitor leakage and the input offset error. 
The integral of the DC offset voltage appears at the output like a ramp voltage, as 
expiained in (Ref. 6]. The power supply can be a source of noise and each pin that is 


connected to a positive or negative voltage must have a capacitor to the ground. The 
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We 


3K6 


» Y=CS 


material the capacitors are made of is a verv important topic as pointed out by 
Roberge in [Ref. 4]. According to the specific application the capacitors must be: 
1. Teflon or polvstirene for the feedback capacitors (integrators) 


2. Solid tantalum electrolytic (greater than ifF) for the positive and negative 
ternunals of the power supply 


3. Mica or glass (0.01 or 0.1pF) for the power connections of each individual chip. 
The offset adjustments were done by connecting the inputs of the particular chip 
to the ground and adjusting the 10 KQ2 potentiometer to obtain zero volts at the 
output. The inputs were grounded before the input resistors to guarantee that the drift 
voltage produced at the input due to these resistors were cancelled by the appropriate 
adjustment. In the case of the integrators, the capacitors must be discharged before 
the adjust. [he switches in parallel with these capacitors (shown tn Figure 4.7) are used 
for this purpose. They are also used to reset the integrators just before running the 
system. In this case, an analog switch. automatically commanded by the software 
Should be desired and was designed. The reconimended switch is the LF 11332. The 
supply could not provide this component. 

The plant was submitted to some tests to make sure the transfer function 1s being 
implemented. One of the tests consists in building a double integrator with an overall 
gain of 100. This particular implementation tests the integrator blocks in terms of 
drifting, oscillations and the integral operation itself. Each integrator has a gain of 10 
as shown in Figure 4.8 . 

The first integrator is driven by the square wave v(t) with a frequency of 100 Hz. 
The integration of the square wave results in an inverse triangular wave due to the 


munus sign of the integrator. Computing the output value of the first integrator at time 








t= 5 msec: 
(t) ea 1Olsde= es 
a) — — a —. CN awe |) en) 
C5 13a 
Mies — at. Where a= 50 V;sec or 0.05 V msec 
ee! Te at wet. 
v(t) = wa atdt = 10 pa 0.625 m\ 
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Figure +.8 Double Integrator. 
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Once the double integrator 1s working well, a good test can be done to compare 
the performance of the digital model and the analog double integrator, since the model 
is also a double integrator with a gain (Km). So, if the gain Km is set to 100, both 
double integrators are supposed to have the same behavior. This is a very interesting 
test because the whole digital servo and interfaces are also checked. The test was 
carried out and the results displaved on the screen. In despite of the manual reset of 
the integrators the test was a success, that is, the values of CS (analog double 
integrator output) and CM (digital model output) were pretty close during all the time. 
Minemset Wp for this test is 1s shown in Figure 4.9 . The differences between this 
implementation and the whole system is that in this scheme the plant is just a double 


integrator and the model parameters are not being updated. 


Pes tevon FPeeacback 






Velocity Feedback 






COORG eLES 


Figure 4.9 Comparison between Digital and Analog Integrators. 


The entire analog plant can be tested and the results compared with the theory. 


Refering to Figure 4.6 one can see that the plant can be separated in two blocks. The 


fal 


first block has input u and output x and the second block has input x and output y. 
These points are directly available in the circuit (refer tone tact 

The second block can be tested in the same Way Used to test ythesdouam 
integrator. Applving a square Wave at input x we obtain a triangular wave at output v. 


The theoretical results are presented in Figure 4.10 and can be obtained as follows: 


The test of the first block is not so trivial. The output is an exponential function 


for a step input as shown tn Figure 4.11. The Laplace transfer function of the olegm 
1s 


A(S) l 


——=—————— = X(s) = —— L(s) 
CAG Ss 





Applving a step input of 10 V, U(s)= 10's, we obtain: 


Then, x(t) =(10/20:55)[1(t) — exp( — 20.551)|= 0.4911 = exp 20 an) 


The theoretical results are presented in Figure 4.11 . Tne input frequency was set 
to 1Hz to pernut the total excursion of the exponential wave. It is important to 
sincronize the oscilloscope with the output to obtain a stable image on the screen. The 
results found in the practical experiment matched very well with those encountered in 
the theory. In all the tests the integrators are supposed to be reset right before testes 

The gain of 275.3 ean be splited between the last integrator and the addemem 


improve the performance of the analog computer. In this case the circuit presented in 
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Figure 4.10 The Second Integrator. 


Figure 4.7 would have the 3K6 resistor replaced by a 36K2 resistor in the last 
integrator (the gain will be 27.3) and the 200K@Q resistor at the adder replaced bv a 
20K Q2 resistor (the gain will be 10). 

Ewiouver 2000 dma casy fest that cam be done to verify the plant design is to 
apply a step input, sav 1 Volt. and measure the output with a strip recorder. The 
equivalent plot can be done in the mainframe using the programs “Controls” or 
“Ewald” and the results can be compared. This test was carried out and the plots 


turned out to be verv simular. 





l t(sec) 
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Figure 4,11 Testing the First Block otine Fame 


The analog plant just discussed represents a motor of a disk driver. A second 
transfer function, representing a robot motor, was also implemented and testeqiiam 


~ 
* 


transfer function was studied in [Ref. 7] and can be written as 


oe 
S . 
ee i 
9100 OO 


G(s) = 


S( 1) 
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This transfer function has a real pole at —9100 that can be neglected and 
Baouler teal oOle very close (oO the origin ( —0.019) that can be approximated to zero. 


Therefore. for practical applications. the transfer function can be written as 





This plant was implemented in hardware by using two operational amplifiers in a 
very simular way as that showed in Figure 4.8 . The only difference is that in the second 
integrator the resistor is | M92, rather than 100 K22 . The gain of 10 is obtained in the 


first integrator to allow a direct test point for the velocity at the output of this stage. 


aS 


V. PERFORMANCE OF Giles) Ses 


A. IHE SCALING PROEEEI: 

As discussed in Chapter II, the input of the system is a commanded step that 
determines the position to be achieved by a robot arm or a disk driver arm. The actual 
position of the arm (CS) 1s represented in this research by the voltage at the analog 
plant output, which simulates the transfer function of the motor and load. So. this 
voltage is a parameter to be measured and converted to an angle in order to compare 
with the desired position and determine the performance of the system. 

Another requirement of the system is the curve following process. that isi¢me 
acceleration of the arm must be maximum until the velocity reaches the deceleration 
curve of the motor and from this point it must follow the curve. The velocity can be 
obtained from the analog plant by connecting an inverter at the input of the last 
integrator. 

At this point, it becomes necessary to explain the scaling problem betweeneae 
analog and the digital world involved in this research. The plant input dimension 1s 
volts and the output dimension is radians. Therefore, one volt at the plant output 
represents an angle of one radian. Since the analog to digital converter is an eight bit 
interface driven by a 5 Volts source, 39 millivolts in the plant output is converted to 1 
at the digital output of the ADC. This conversion and other examples are illustrated in 
Hable Ss. 

Based on this tabie the input R applied to the system is a muliipleyoiaaaee 
degrees. Also, the number that represents the gain constant, Km. in the program mies 
take the scaling factor into account. Thus, for a Km equal to 300 radians per second 


we will have. in decimal representation: 


Km = 300) X 57.2793 5 — 7. 


Cn 


With the actual ADC the system can handle angles from 2.23 deerees Tomas 
degrees. This resolution can be improved by increasing the number of bits in the 
interface. For instance. ifa 12 bit interface 1s used and the reference voltage 1s) he jeumee 
same (5 V), the mintmum angle will be 0.14 degrees and the maximum will be 286.34 


degrees. 
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TEA us 
ieee Le PROBE vl 


ADC Input : ADC Outvut : 
@s( Volts) CS( radians) CS( degrees) ' Decimal Hexadec. 
0.039 | = 0.039 23 | i i 
31 Onell 17.9 | 8 8 
0.62 | 0. 62 35.8 16 10 
2.50 2.50 1D | 64 | 40 
Bil Pe cean / lone 80 50 
4.38 Aes | 250.7 | ate ee 


Bee RESULTS 

AS pointed out earlier, the system receives an input command from the keyboard 
and the analog output of the plant must respond as quickly as possible by using a 
curve following scheme for the velocity. In the case of this research, the performance of 
the system was checked by several means. 

During the development phase, while the system was not working as in its final 
version, the tests were done by using the routine Display, off-line (refer to Appendix 
C). After a run, all the important variables were presented on the screen and we could 
analyze what happened in every loop of the program. Also. the output of the analog 
plant was ooserved in the oscilloscope just to verify if the final position was reached or 
not. in this phase the velocity of the model was considered to be the same as the 
velocity of the plant. Thev are supposed to be similar if the algorithm works well. 

After the system started operating well under the verification tests mentioned 
above, a strip recorder was used to check the position and velocity of the plant. The 
position is readily available from the analog plant output and the velocity is obtained 
Peeteking the input of the last integrator { — CSDOT-;27.3) and driving it through a 
amplifier (and inverter) to get the actual velocity. 

The voltages obtained in both cases , position and velocity. are then converted to 


radians and radians per second, respectively. The tests were carried out for both plants 


(disk driver motor and robot motor), using several inputs (R). The results are 
summarized in Figures 5.1 through 5.10. tn all plots the velocity of the strip mecemaam 
was fixed in 125 mm sec {maximum available). The plots are presented in {icusaaam 
scale they were obtained from the plotter. 

Looking at Figure 5.1 we can see that there is some overshoot in the position 
(CS) plot. In a real application the bang-bang control would be replaced by a linear 
compensator when the position 1s reached and this would prevent the overshoot or 
would reduce it to an acceptable value. In all the velocity plots it can be noticed that 
the full acceleration process occurs approximately over half of the trajectory. At the 
maximum point of the curve the actual velocity of the model (CDOT) ona 
(CSDOT) crosses the curve of the desired velocity (NDOT). From this poimeumaee 
deceleration curve of the motor is followed and the velocity drops following NDOT. 

In some cases the actual velocity (CSDOT) stays a little bit greater than eames 
and no “chattering” is observed as can be seen in Figures 5.1 and 3.2, for instance. In 
other cases CSDOT alternates being greater or less than NDOT and the Chatters 
can be 10ticed as m Figures > and 5.5 (ior instamec: 

The conunanded input in the kevboard 1s an hexadecimal quantity (last column 
of Table 8) and using the conversion presented in the Table we can label the plots in 
radians and radians per second. It 1s easily seen from the plots that the robot plant 1s 
much slower than the disk driver plant, as can be confirmed by comparing the abcissas 


(tinie) in the position plots and the ordinates in the velocity plots. 
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Posmmenvane Velocity for a Disk Driver Motor, R = 0.31 rad. 
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Ficure 5.2 Position and Velocity for a Disk Driver \iotor, R=" 0iGeanee 
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Biture 5 Position and \elocity for a Disk Driver \fotor, R = 1.25 rad. 
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Figure 5.6 Position and Velocity for a Disk Driver Mfotor, R = 4.38 rad. 
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Position and Velocity fora Robot Motor, R = 0.62 rad. 
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Figure 5.8 Position and Velocity for a Robot Motor, R = 1.25 rad. 
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Figure 5.9 Position and Velocity fora Robot Motor, R = 
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Figure 5.10 Position and Velocity for a Robot ‘lator, k= ieee 
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Vee Meee So ONS Ait aseLORrURTRER STUDIES 


The control of a robot arm or disk driver arm in minimum tune (curve following) 
and autoadaptive was implemented using a microprocessor. The software was designed 
to work as a servo mechanism with curve following and to implement the algorithm 
that updates the model based on samples coming from the arm position. An analog 
computer simulated the motor and load of the arm. 

Two different transfer functions for the analog plant were tested, one for a disk 
driver motor and other for a robot motor. The first plant (disk driver) is found in 
fcr }| and the second comes from [Ref. 7]. 

The initial goal of this research was to build a model to roughly represent the 
device (plant) to be actuated and bv sampling its output to update the model in order 
memniiiinize the error between them (model and device). Once the model 1s a “copy” of 
the plant it can be controlled bv using velocity feedback, position feedback and curve 
following in the model and then applying the same input to both plant and device. 

The actual algorithm that updates the output of the model and the “gain 
constant’ Km, does not update the velocity. The technical reasons why the velocity 1s 
Meeepeine updated were explained in Chapter 111, but the fact ts that the lack of 
velocity updating did not influence the performance of the system at all since the 
velocity computed for the model is based upon the updated value of Km and in an 
indirect way, the velocity 1s being updated. 

The commanded input was apphed from the keyboard in order to easily check 
the system for different inputs. However, as pointed out in Chapter I, this input can 
come from a central computer and. in this case, several systems like the one described 
here could be used to actuate different arms. 

The results presented in Chapter V show that the svstem works and can be used 
in a real application. It was also pointed out that it can be improved. One of the 
mefeecis that cam be worked out is the interface. [he system can go from a resolution 
of 2.25 degrees (eignt bits) to a resolution of 0.14 degrees by just changing the interface 
(ADC) to a twelve bit ADC. For a sixteen bit ADC the resolution would go to 0.0087 
Beerecs, Ihe problem here is that at this level the noise starts corrupting the results 


and additional arrangements (filters, isolations, etc.) must be incorporated. 
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Another improvement in the performance of the system would be to transform 
the whole program to a 32 bit program. The impact of this change would be in the 
accuracy of the system. The actual program does several operations Using yo2em 
floating point features of the Arithmetic Processing Unit as in the curve computation 
and in the trapezoidal integration. One concern about the use a 32 bit program is the 
time. Flowever, a good measure to mininuze the execution time is to cut olf alle. 
subroutine calls and imbed them into the main program. 

Another important topic for a future research 1s to connect the microprocessor 
with a real motor and arm and increase the resolution to 12 bits. Also, the movement 
of the arm coud have two stages: a large movement. using a resolution of 2.25 degrees 
(8 bits) and a fine adjustment using a resolution of 0.14 degrees (12 bits). The $ bit 
interface would allow a faster manipulation of the data during most of the trajectory. 

The basic idea and the skills necessary to implement a new hardware ; software 
Or improve the one reported here were provided in this research. However, the best 
legacy of this thesis is the proof that. an autoadaptive algorithm applied in a real time 


programming for disk drivers and robots can be used succesfully. 
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. 28D 
EXTRN 
EXTRN 
EXTRN 
EXTRN 
PUBLIC 


2 
ZERO 
iat 
PVSAT 
MVSAT 
LOC F 
KMC 
KIA 


APPENDIAX A 
PROGRAM MODEL - 16 BITS 


SCRLF »GETSTRIN »>HEXCONV ,GHEXERR,R»CM,CDOT ,CODOT ,COM1,CDOM1 > KM 
N>V>CS ,CSM1 ,CSM2 ,NUMBER , QUOT ,ONES, TENS» HUNDREDS , THOUS » TTHOUS 
RSSTAT »RECV ,»MESSAGE , MONITOR ,HELLO,BOUT » TRAP3D ,MONLOOP ,SPACES 
ECHO ,ASCONV, TEMPLY >CNCF CF »>MFLAG,NN,KMFLAG NS 


MODEL» TRANSFER ,DISPLAY 


EQU 0 

EQU D6éBCH sINTEGRATION STEP (T1=2/T) 

EQU OAH sPOSITIVE SATURATION LIMIT=+1D 
EQU DEFF6d sNEGATIVE SATURATION LIMIT=-1D 
EQU 12H >TI/CF=18, T1=180D AND CF=10D 
EQU 381CH sKMCSCONSTANT IN THE ALGORITHM 
EQU 8CH 30.8*SQRT(2.VSAT.KM) 


> 
s3THIS PROGRAM SIMULATES A SERVO SYSTEM. 
3THE VARIABLES HAVE THE FOLLOWING MEANING: 


3R 


3;CCOT 
sc ODOT 
3;CDM1 
3;CDDM1 
> 

5 
MODEL: 


LOOP: 


Mei ss < 


POSTUrLeN OCT PUT 


VELOCITY 


aCCELERATION 


Stee anne) OR POSsli ICON iO GE ACRIEVED BY THE OUTPUT 


PREVIOUS VALUE CPAP MesVELOCLT 


PREVIOUS VALUE OF THE ACCELERATION 
CALL SCRLE 
LO A,83H sPORT A IS OUTPUT TO D/A; 
CUT (O3H)>,A >PORT B IS INPUT FROM A/D, PORT C 
LO A,7FH s;UPPER IS OUTPUT ,LOWER IS INPUT 
OUT (QOH),A 3;RESET THE O/ZA OUTPUT, XxXDOTE=D 
LD A»,8DH > 
OUT (D2H},A 3;DISABLE A/D CONVERTER 
LO B,1DH >THIS BLOCK RESETS THE VARIABLES 
LO AES CH 3CM,CDOT ,CDDOT ,CDM1,CDDM1 ,CSM1,CSM2 
LD (HL},ZERO 3AND CMCF 
INC Ae 
DINZ LOOP 
LD HL,OD6SH 
LO CEFIs AL SCORRECTOR FACTOR<--—- 100 
LD A,0ODH 
LD (MFLAG),A sMODEL FLAG IS SET TO ZERO 
LD (NSJ,A sNSUESTORAGE CONTROL J<--- 0 
LD (KMFLAG),A 3;ALGORITHM FLAG 
LO HL,D5DDH 3KM=256*5=128D 
LD (KM), HL > 
LD HL,DDO1H soe COUNTER 10 ONE 10 BE USED BY 
LO (NN),HL 3NIKSTROM ALGORITHM 
LD HL»,DOH 3HL<--- DOH 
LO (NUMBER),HL sNUMBER<--- D 
LD (QU9T ),HL 3;QU0T<--- D 
CAEL SEKEF velNe FeeD 
LD fe He LG 3SET UP POINTER TO MESSAGE 
CALL MESSAGE 3ASK FOR POSITION INPUT 
CALL SERIE 
CALL GETSTRIN >GET CHARACTER FROM KEYBOARD 
CALL HEXCONV sCCNVERT INTO HEX 
JP C,GHEXERR 3IF ERROR IN THE INPUT 
LO (R),DE >SAVE POSITION IN R 
CALL SCkeEr 
LO IY ,16DDH s3INIT. DISPLAY ROUTINE POINTER 


on 


PLOOP : 


POSTIIVE: 


OK: 


PLUS: 


VOLTS: 


5 


sTRAPEZOIDAL INTEGRATION 


LO 
CALL 
CALL 
LD 


LO 
LD 
LD 
OUT 
LD 
OUT 
LD 
OUT 
LD 
OUT 
LD 
OUT 
LD 
OUT 
LD 
OUT 
LD 
LD 
OUT 
LD 
OUT 
LD 


DE ,(CM) 
HL, (R) 
SUBTRACT 
STORE 

C,0 

7>H 

2>POST TIVE 
Co 

Aol 


H»A 
STORE 
DE>1 CORT } 
SUBTRACT 
STORE 
foH 
Z»PLUS 
HL »>MYSAT 
A,ODH 
{DOH)>,A 
A,O1H 
(KMFLAG),A 
VOLTS 
HL »PVSAT 
A,OFFH 
(Q00H),A 
(V),HL 
£,(KM) 
MUETERLY 
STORE 
(CDDOT),HL 


3DE<---OUTPUT POSITION 
sHL<---INPUT POSITION 

;POSITION ERROR=HL<=---HL=DE 

sSAVE POSITION ERROR 

sSET FLAG TO ZERO FOR POS. NUMBERS 
;LF NUMBER IS °POSITEvVEs 

3G0 TO LOCATION “POsrnive. 

3IF NUMBER IS NEG), SET FlaG 1Ger 
;CONVERT IT IN A POSITIVE NUMBER 
sA<--- O-A (INVERTS THE A SIGN) 


3HL<---SQRT( ERROR )¥K1*SQRT( 2KM.VSAT ) 
$IF FLAG IS 0,(THE ERROR WAS POS. ) 
360 TO "OK" 

>THE ERROR WAS NEGATIVE! SO, 
s;CONVERT IT BACK TO NEGATIVE 


»SAVE XDOT 

sDE<--- CDOT 
»>XxDOTE<--- XDOT-CDOT 
3;SAVE XDOTE 

;1F XDOTE IS POSITIVE 


sGO TO PLUS 
sHL<--- -10 

[ne ——— 0 

3;DAC<--- -1D VOLTS 


sSET KMFLAG TO 1 WHEN XDOTE< O. 
> SMF LAG™ <= 

3GO TO VOLTS 

»DAC<--- +10 


sAC--- FF 
;DAC<--- -10V 
3¥ IS SAVED 
;DE<--- KM 


sHL<--- CDDOT=KM*V 
3STORE CDDOT (FOR DISPEAY PURPOSES? 
sSAVE NEW VALUE OF CDDOT 


INPUT IS ACCELERATION, OUTPUT LS VeLlocra. 
STHIS BLOCK DOES COOT=COM1+( CODM1+CDDOT I*T 72 IN $2 Bil FLOAT HE Searrit 
5TRE INTEGER is COMPUTED TO SE DISPLAYED GFE Utne. 


DE,(CDDM1) 
(CODM1),HL 
A>L 
(D8H},A 
A>H 
(O8H),A 
A,1DH 
(O°H),A 
A,E 
(O8H},A 
A»D 
(QO8H},5A 
A,10H 
(QO9H),A 
A»,1DH 
(DOH),A 
DE,T1 
A,E 
(Q8H),A 
A,D 
(O8H),A 
A,1DH 


;DE<—-=—" Chphe 
3CDDM1<--- CODOT 
,APU<--- CDOOT 


3 TOS( APU )<--- FLOAT(CDDOT ) 


sneUc—-—-—- CHUML 


$TOSCAPU }<--- FLEOATICEENT) 


;NOS<--—- COPOT+ERorE 


3;DE<--- 2/T 
sAPU<--- Tl1 


,10S<=-—- FLOAT (Te) 


oe 


5 


;TRAPEZOIDAL INTEGRATION 
3f1HIS BLOCK DOES: CM=CHil+(COMI+CDOOT )*T/2 


b 


LO 
CUT 
LO 
OUT 
IN 
LD 
IN 
LO 
LO 
CALL 


(O9H),A 
A,13H 
{O9H),A 
DE ,( QUOT ) 


HL > (NUMBER ) 


A,E 
(O8H),A 
A»,D 
(O08H),A 
AyL 
(O8H),A 
A>H 
(08H ),A 
A,10H 
{O9H),A 
A,( 08H ) 
H,A 

A,( 08H ) 
L>A 
A,(08H) 
D,A 
A,{08H) 
E,A 


(NUMBER ),HL 


(QUOT ),DE 
A,E 
{08H),A 
A,D 
(O8H),A 
A>L 
(OSH)>A 
A>H 
(O8H),A 
A,1lFH 
(O9H),A 
A,(08H ) 
H,A 
A»(08H ) 
L»>A 

{CDOT ),HL 
STGRE 


5 
s9es<—--— (CO00TtCDOMLII72 


sDE<=-=-LSSYTE OF COOT (FLOATING) 


pmes=—-Moerte OF COOT (FLOATING) 
3TOS<--- COOT (FLOATING POINT ) 


3 TOS<---CDOT +{ CODOT+CO0M1 IT/2=COOT 


3NUMBER ,QUOT<--- FLOAT(CDOT } 


;RETURN COOT (FLOAT) TO APU 


sy Goc=—— INTEGER(COOT ) 


sHL<--- INTEGER( CDOT ) 


sSAVE COOT 
yeRGie lS shOReED TO BE DISPLAYED 


DMeUreis VELOCITY 


DES CoM) ) 
(CDM1LI,HL 
ADDITION 
DE,T1IOCF 
DIVIDE 

DE ,(CMCF ) 
ADDITION 
(CMCF),HL 
DE; (CE ) 
DIVIDE 
(CM),HL 
STORE 
ANALOG 
STORE 
VWIALG 

HL, CNN) 
STORE 

HL 
(NN),HL 
A,(NS) 

A 

{(NSJ,A 
01H 
EyRESET 


3;DE<--- COM1 

3;CDM1 IS UPDATED (COM1<--- COOT) 
sHL<--- CDM1+COOT 

3DE<--- T1/CF=18 
sHL<---(COOT+COM1 )/TIOF=COOT*CF/T1 
3DE<--- CMCF (CM *100) 
sHL=CMCF=CMCF +( COM1+COOT )*¥T/2 
sCMer 5 UPDATEDU 

;DE<--- CF 

3;HL<---CMCF/CF = CM 

3CM IS UPDATED 

sSAVE CM (MODEL OUTPUT ) 
s>HL<---CS FROM ANALOG PLANT 
sSTORE CS FOR DISPLAY PURPOSES 
3KM AND CM ARE UPOATED 

3;HL<--- LOOP COUNTER 

;STORE LOOP COUNTER 

s;INCREMENT LOOP COUNTER 

;SAVE LOOP COUNTER 

3A<--- NS 


Shoe ——-— Not] 


3LS NS=1? 
fur YES, GO TO RESET. 
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RESET: 


SCREEN: 


CONTINUE : 


? 


A,OFFH 
(MFLAG)>A 
SCReEr 
A,(MFLAG ) 


(MFLAG),A 
A»,0 
(NS),A 
(N),LY 
A,(N+1) 
24H 


NZ ,CONTINUE 


A,55H 
(MFLAG),A 
PLOOP 


sA<--- FF 

;MPLAGC==—— ee 
3GO0 TO SCREEN 

jmSa--- MFLAG 
;COMPLEMENT THE FLAG 
sjMFLAG IS COCMPLEMENTED 


sA<--- OQ 
sNS<--- 0 
»N<--- IY 


sAC=== HIGH Byte enei, 

31S IT 242? (MEMORY ENDS Al 2Serne 
SIF IT IS NOl> GOR oeceni ine 

3SET MFLAG TO AVOID FURTHER STORAGES 
sSINCE THE MEMORIES @eree rue: 
sENDLESS LOOP 


5 EE HIE III IE IH IKK HE IEE IK IH IE HII HK IE RHI II KE HEHE HH HHH IK KK KKK KKK 
5 MRK KKK KRM RKKERKEKEX END OF MAIN PROGRAM 4344 K KIKI HII HK HEHEHE KKK 
$ IEE KH EI IK KLIK HK IIE KKK IE KIKI KKK IKKE KI IK IIE IKK HEHEHE 


5 
$THIS SUBROUTINE INPUTS THE ANALOG OUTPUT FROM THE PLANT (CS) 


> 
ANALOG: 


HOLD: 


GCOD: 


5 


>THIS SUBROUTINE 


LD 
OUT 
IN 
CP 
JR 
IN 


OUT 
RET 


A,0 
(O2H),A 
A,(02H) 
0 
NZ,HOLD 
A,(01H) 
&,80H 
7A 

Z »GOOD 
A,0 
LoA 
H,0 
(CS),HL 
A,80H 
(O2H),A 


$ENABLE THE ADC CONVERTER 
sPORTC<--- 00 

3A<--- READY LINE FROM A/D VIA P.C 
$IS A/D READY? 

sIF NOT, VERIFY AGAIN. 

sAc—--= €S PROM POR 

;CS IS CONVERTED 1952935 CONPLEMER 
»CHECK OVERFLOW DUE TO NEGATIVE 
;sVOLTAGE FRCM A/D. LP THERE is 
;OVERFLOW, A<---0 


>L<=== CS 
;H<=—-0 
SSAVE CS 


3A<--- CONTROL WORD TO DISABLE ADC 
SPORT C<---—60n 


IMPLEMENTS WIKSTRON ALGORITHM TO COMPUTE KM AND CDOT USING 


3THE ANALOG OUTPUT FRCM THE PLANT(CS). THEN,CM,CDOT AND KM ARE UPDATED 
sKM=2CS/VSAT (NT )¥*2 AND CDOT=(CS-CSM1)/T. OR» KM=(16529/N**2 )*CS*¥10, WHERE 
>T=1.1 MS AND VSAT=10 


> 
WALG: 


KMSMALL: 
KMEIA: 


LD A»y(KMFLAG ) sVERIFY FLAG. IF ff is 1 0G NOT 
CP 0 ;COMPUTE KM ANYMORE. KEEP THE 
JR NZ »KMFIX ;LAST VALUE. 

LD HL ,KMC sHL<--- KMC=2/VSAT*T*¥2*10 

LD DE ,(NN) ;0DEG-—— COUNTER 

CALL DiVIGE sHL<--- KMC/N 

LD DE, 1CS} 7; DES -— Co 

LD A,E SA CS 

CP 0 > 

JR Z»KMFIX 3IF CS=0, KEEP INITIAL KM 

CALL MULTIPLY sHEC===( KiMC7NI*GS 

LO DE ,(NN) >DE<--- NN 

CAEL DIVIDE sHL<=-— (KMC/NXX2 JxEs 

ED DE ,OAH ;DE<--- 10 

CALL MULTIPLY sSHL<--- (KMC/N¥¥2 )*CS*¥1O=KM 

LD A>H 3ac-—— MSs Ofer 

CP OCH s1—& KM > 39725 Sel iio GCCCH 
JP M,KMSMALL ;ELSE, GO TO KisrAce 

LD DE; 0GcGH ;DE<--=- OCCCH = 3276 

LD (KiM),DE pe Sera 

JR KMFIX 3GO TO KHHFIX (DO NOT GO TO KMSMALL } 
LD (KM)>HL sKM IS UPDATED 

LD HE CCS) (he co 

LD (CM) 5 HE sCM<--- CS, CH IS UPUaTED 

CALL STORE 3STORE NEW VALUE OF CM 
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RET 


b 
3ADDITION ROUTINE USING THE INTEL APU 8231 


> 

ADDITION: CALL OUTOP 
LD A,oCH 
OUT (O9H)>5A 
CALL INOP 
RET 


Giese tle 


$ SEND OPERANDS TO 8231 
3ADD COMMAND 


3 GET RESULT AND STORE IN HL 


5 
fous TRACTION ROUTINE USING THE APU 8231: HL<--= HL-DE 


> 

SUBTRACT: CALL OUTOP 
LD A,6DH 
OUT (O9H),A 
CALL INOP 
RET 


v 


> 


sMULTIPLICATION ROUTINE USING THE APU 8231: 


5 

MULTIPLY : CALL OUTOP 
LD A,6EH 
OUT (O9H)>5A 
CALL INOP 
Rea 


5 


$SEND OPERANDS TO 8231 STACK 
$SEND COMMAND SUBTRACT TO 8231 


>GET THE RESULT FROM 8231 


fis o> house 


3SEND OPERANDS TO 8231 
3SEND COMMAND MULTIPLY TO 8231 


3GET THE RESULT AND STORE IN HL 


3THIS SUBROUTINE COMPUTES (SQRT( ERROR) )¥K1*¥SQRT(2.VSAT.KM) USING 32 BITS 
s$FLOATING POINT OPERATIONS OF THE ARITHMETIC PROCESSING UNIT (APU). 


CURVE: LD AL 
OUT (O8H),A 
LD A>H 
OUT (Q8H),A 
LD A,1DH 
OUT (O9H),A 
LD A,0O1H 
OUT {09H),A 
LD DE ,KIA 
LD A,E 
OUT (O8H)>A 
LD A,D 
OUT (O08H},A 
LO A,1DH 
OUT (O9H),A 
LD A,12H 
OUT (O9H),A 
LD A,1lFH 
OUT (O9H),A 
IN A,(08H) 
LD H»A 
IN A,( 08H} 
LD Uae 
RET 


3SEND DATA TO 8231 (16 BITS) 


3SEND COMMAND TO CONVERT 16 BITS 
sINTEGER TO 32 BITS FLOATING POINT 
3SEND SQRT COMMAND 


} 
3DE<--- K1lA=K1.SQRT(2.VSAT.KM) 
3APU<--- KIA 


* 


3 

5 

5 

3TOSC APU )<--- FLOAT(KI1A) 
5 

sMULTIPLY K1A*SQRT(E) 


> 
;CONVERT THE RESULT TO 16 BITS 


> 
SSUORE He RESUEN IN HE 


5 
migee ROUTINE STORES INTERMEDIATE RESULTS TO BE DISPLAYED OFF LINE 


} 
STORE : LD A,(MFLAG }) 
CP 0 
JR NZ ,NOSTOR 
LD Cry o5e 
INC Ly 
ED (IY),H 
INC TY 
NOSTOR: RET 
> 
»DIVISION ROUTINE USING THE APU 8231: 
> 
DIVIDE: CALL OUTCP 
LD A,oFH 
OUT (O9H),A 


VYERLEY MPLAG STALUS. 
PRE Et IS 0; STCRE DATA. 
FELOE> DO NOT STORE. 
;MEMORY<--- DATA (LON) 
pivels INCREMENTED 
s3MEMORY<--- DATA CHIGH ) 
s2Y SES INCREMENTED 


fee Ae 


;OUTPUT OPERANDS TO 8231 STACK 
»;EXECUTION COMMAND FOR DIVISION 
PESroeNte Toe e2 51 


a» 


CALL 
RET 


INOP 


> 
sTHIS ROUTINE OUTPUTS OPERANDS TO 8231 


> 
CUTOP: 


> 
sTHIS ROUTINE INPUTS THE 


* 
> 


INOP: 


LO 
OUT 
LO 
OUT 
LO 
OUT 
LO 
OUT 
RET 


Aol 
(O08H),A 
A>ad 
(08H),A 
A,E 
(O8H),A 
A,D 
(O8H),A 


sINPUT THE RESULT FROM 8231 


STACK: NOS<——-iee)©s<.-—e 


sHL IS SEND TO S2stesieen 


3DE IS SENT TO S251 STACK 


RESULT FROM 8231 APU: HL<==— [0S OF acze 


A,(08H) 
H,A 
A,( 08H} 
L»A 


;HL<-=— TOP OF SIaen 


5 
$THIS ROUTINE CONVERTS THE DATA FROM HEXADECIMAL TO DECIMAL AND DISPLAY THEM. 


> 


DISPLAY: 


NLOOP: 


POS: 


CONVERT: 


LD 


IY »1600H 
A,QDFH 
(NJ>A 
&,00H 
(NSJ>A 
Lat Ly) 
Ly. 

H,( IY) 
Ty 

7oH 
z2,POS 
A>H 


H yA 
AsL 


LoA 

A,2DH 

ECHO 
CONVERT 
B,O1H 

SP aces 
(NUMBER ),HL 
DE ,OAH 
DIVIDE 
(QUOT ),>HL 
MULTIOLY 

DE »HL 

HL» (NUMBER ) 
SUBTRACT 
(ONES }>5HL 
LONGDIV 
(TENS? 3HLE 
LONGDIV 
(HUNDREOS }>HL 
LONGOIV 
(THOUS )>HL 
LONGDIV 
(TTHOUS )>HL 
A,(TTHOUS ) 
ASCONV 

A,( THOUS ) 
ASCONV 

A,( HUNDREDS) 


sPOINTER<--- 14¢00H (DATA LOCATION) 
3A<--- AMOUNT OF MEMORY AVAILABLE 
3SAVE THE INFO AT COUNTER N 


sNS<--- 0 
sL<--- DATA (LOW) 


sHic——=— DATA (HIGH) 


;CHECK MSB (IS THE NUMBER NEGATIVE?) 
;LF IT IS PCSITIVEs Gemie ros 
3IF NOT,A<=--- H( DATA-HIGH ) 
;COMPLEMENT MSSYTE 

3PUT IT BACK TO H 

3A<---L (DATA-LOW) 

3A<--=- O-A (2'S COMPLEMENT ) 
>PUT IT BACK TO L 

,A<=—=— ASCII FOR —-esich 
;DISPEAYS = slGn 

360 TO CONVERT 

3B<---O1H, TO PROVIDE ONE SPACE 


s;NUMBER<---DATA TO BE CONVERTED 
3DE<--- 10 (BASE FOR CONVERTION ) 
sHL<--=- NUMBER/10 

;GUOTIENT<--- NUMBER/10 
»>HL<-—--QUOTIENT*10 
3DE<---QUOT*10 

»>HL<---NUMNBER( DIVIDEND ) 
>HL<---NUMBER-QUOT*1O=REMAINDER 
S;ONES<---REMAINDER 

sHL<--- NEXT REMAINDER ( TENS} 
3>TENS<--= REMAINDER 


sHUNDREDS<---REMAINDER 

$s THOUSANDS <---REMAINDER 

3 TENTHOUSANDS<--- REMAINDER 
3A<--- TTHOUS 


sCONVERT A TO ASCII AND OISPLAY 
3SAME THING WITH TRE S ORGITS 
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CALL ASCONYV 


LD A,( TENS) 
CAEL ASCONYV 
LD A, (ONES) 
CeCe ASCCNV 
ee) B,O2H 
CALL SPACES 
LD (TEMPLY ),LY 
ED ASCTEMPLY 
AND OFA 
Ce 0 
JP NZ ,DLOOP 
CALL SEREF 
LD A,(N) 
DEC A 
LO (N},A 
OS) 0 
JR Z»END 
LD A,(NS) 
INC A 
LD (NS ),A 
CP OAH 
JP NZ ,DLOOP 
WAIT: IN A,(RSSTAT) 
AND 2 
JR Z,WAIT 
IN A,(RECV) 
LD A,O 
LD (NS),A 
JP DLOOP 
END: RET 


5 


3B<=---012H TO PROVIDE 2 SPACES 

»PUT THO SPACES BETWEEN NUMBERS 
$STORE POINTER 

3A<--- POINTER.LOW 

SCHE CK Foe OF THE POINTER 

SCOMPARE NETH ZERO. IF IT IS NOT 

30, THIS ROW IS NOT COMPLETED >REPEAT 
Weis. GO 19 THE NEXT LINE 
3A<--- COUNTER (MEMORY SPACE) 


3N<=-= N-1 

3END OF MEMORY? 

Lf ¥Es>CO TO END. 

[ao -- Noe GU borPlAY CONTROL } 


s;NS<--- NS+1 

31S NS=10 ?7(IF 10 RUNS HAS ELAPSED ) 
3IF NOT, GO TO DLOOP 

FCHE ee tHee weYoUaRD INPUT. IF NO KEY 
s3NWAS HIT, WAIT. 

3;ELSE, RESET AND REPEAT PROCESS 


sA<--- 0 
3SET NS TO ZERO AGAIN 


inl oeoUGROUTINE CCMPUTES THE LONG DIVISION FOR THE SUBROUTINE DISPLAY 


5 

LONGDIV: LD DE ,OAH 
LD HL »( QUOT ) 
LD (NUMBER ),HL 
CAEE DIVIDE 
LD (QUOT ),HL 
CALL MULTIPLY 
EX DE ,RL 
LD HL ,( NUMBER ) 
CALL SUBTRACT 
RET 


5 


>THIS BLOCK TRANSFERS THE ROUTINE MODEL 


> 

TRANSFER: LD HL,»MODEL 
LD DE »1000H 
LD BC ,Q3A0H 
LDIR 
RET 
DS i 
END 


3DE<--- BASE FOR CONVERSION 
sHi<—-— QUOTIENT 

SSAVE NEXT DIVIDEND( LAST QUOTIENT ) 
fae GUO reNT/ 10 

3SAVE NEXT QUOTIENT 

3HL<--- QUOT*10 

3DE<--- QUOT*10 

pee nen DEY LDEND 
;HL<---DIVIDEND-QUOT*1O=REMAINDER 


FROM EPROM TO RAM, ADDRESS OAOO 


$ae<-—-S0URCE ADDRESS 
3DE<---DESTINATION ADDRESS 

$b G——-——-BLOEKk oIZE 
>TRANSFER,INCREMENT HL AND DE 
SDECREMENT BCSITF IS NOT ZERO 
pROPoA PROCESS. 


Oa 


APPEND ESE 
NIONITOR 


1. KIONITOR FEARS 

The monitor is a program that provides all the software support for the 
microprocessor. It works as a supervisor of the system. When the reset Switch ism 
the monitor takes over. The program counter 1s loaded with address zero and the 
monitor starts performing the initialization routines. The stack pointer is initialized. the 
serial port (video terminal communication) is set up and some messages are sent to the 
screen. After that the monitor (program “Main”) waits for a command from the 
keyboard. 

The first message sent to the screen is a presentation of the system and the 
second one asks for a command (E. D or H). Taking the first choice, that 1s, 1 pice 
forces the program counter to be loaded with the program Model address and the 
program will be executed. If ”D” is chosen, the results of the last run will be displaved 
on the screen (program counter is loaded with routine Display address) .If key H 
(Help) is typed, a list of features provided by the operational system is presented on the 
screen. All the possible utilizations of the monitor are included in the mentioned list. 
These features will be detailed in the next paragraphs. 

The “List” command permits us to list a portion of the memory. For instances 
look at the memory from addresses 1OOO0H to L1O00H the appropriate command 1s: 
POCO 100 ters. 

The “change” command allows us to make changes in the memories (RAM). 
Thus, even smail routines can be written in the spaces available. [t is a powerlulyroa 
for debugging programs. For instance, to change data between addresses 15BOH and 
ISBFH the command should be : CISBO,1SBF<ret>. After this command tiem 
contained at memory location I5BOH will be displayed and the cursor will be at the 
first nibble of this data. To change the actual data. just type the new one. To Skiiaee 
address. (Ve Rent. 

The “Go” command permits us to run a program that 1s already in the wR ae 
Suppose a program was written in the example just mentioned between the addresses 
ISBOH and ISBFH. The command to run this program is the following: 


G15B0.15SCO<ret>. Notice that the end address is one address ao0ve stincuae 
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instruction location. The program will run and the CPU registers will be displaved at 
MiewenGs SO, 1. wae program mas loaded Some results into these registers, they will be 
available. Also. all the memories addresses can be checked by using the “List” 
command. The end address of the “Go” command is called “breakpoint” and can be 
any address inside the program. This allows a valuable debugging process of the 
prograni. 

The “Registers’ conmmand is used to look at the CPU registers (on the screen). 
The command 1s issued by tvping: <R>. 

Mies tramsier “command 1s Wsedsiowthamsicr the program ~Nlodel” from the 
EPROM to the RAM (address 1O0Q0H). It is issued by tvping <I>. Once the program 
is in the RAM it can be modified by using the “Change” command and can be 
debugged and executed by using the “Go” command. 

When the program “Model” is transfered to the RAM it can be executed by 
heme — >=. In order to run the program Model” in the RAM it is necessary to 
change the address of the last instruction of the main program. This instruction is a 
jump to the beginning (JP PLOOP) of the program that is now at a different address 
Mie original address is in the EPROVI). So, we have to find out the new address of 
SaeOOP in the RAV using the PRN file of program “Model” and then change the 
fastruction “JP PLOOP’. 

The “Display” command is a feature that permits the presentation of the 
variables of program “Model” on the screen after the execution of the program. The 
variables are stored in the data memory every time the program is executed in the 
EPROM or RAM. This comimand is issued by typing <D>. The variables to be 
fieeeiceG OF} the screen are : Error, ADOT, XDOTE. CDDOT, CM, CS and NN 
Mommmeer Of loops). After the command the first ten rows are shown. To get the next 


femecows, hit anv kev. 


2. MONTTOR PROGRANIS 
In this section the programs that belong to the monitor are presented. They 
were developed during the EC-3800 course and modified a little bit to be used in this 


thesis. 
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EXTRN 
PUBLIC 
PUSLIC 
PUBLIC 
PUBLIC 
PUBLIC 
PERLE 
PUBETE 


BKPT: 
BUFFIN: 
CHAR: 


EADOKESS: 


FLAG: 
HESOUF: 
OPCODE: 


SADDRESS: 


TAX: 
MCOVAR: 
MFLAG: 
NS: 
KMFLAG: 
TEMP: 
RECV 
XMIT 
RSSTAl 
RSMODE 
RSCMO 
PCREG 
SPREG 
IYREG 
IXREG 
HLALT 
DEALT 
BCALT 
AFALT 
HLREG 
DEREG 
BCREG 
AFREG 
R 
CM 
CHEE 
COUGT 
CODOT 
COML 
COOM1 
Cs 
CcSM2 
N 
V 
KM 
CCUNT 
cS 

YUMBER 
QUOT 
ONES 
TENS 
HUNDREDS 
THOUS 
TTHOUS 
TEMPILY 
Cr 
NN 
RSTART30 
FALSE 
TRUE 
BS 


COMMAND »ERRMSG »MESSAGE »MONMSG »SCRLF , TRAP30 , TRANMSG »BOUT , TYPMSG 
BXPT »5BS,BUFFIN»,CHAR,CR,EADDRESS ,ESC > FALSE ,FLAG, FMDARW 

HEXBUF ,LF »MCNLOOP ,OPCODE ,RECV,RSSTAT »RSTART30 

SPACE ,SADDRESS » TEMP , TRUE, XMIT 

STAX,AFREG »,BCREG ,DEREG»HLREG,»AFALT ,BCALT ,DEALT ,HLALT 
PCREG»SPREG>»IXREG,IYREG»V>CS »>MFLAG»NN,KMFLAG NS 

MONITOR ,MOOVAR >R»>CM,COOT »,CDDOT ,CDM1,CO0M1,KM,COUNT »CSM1,CSM2 »N 
NUMBER , QUOT ,ONES, TENS »HUNDREDS , THOUS » TTHOUS » TEMPIY ,CMCF,CF 


OSEG 


OS 


> 


EQU 
EQU 
EGU 
EGU 
EQU 
EQU 
EQU 
EQU 
E QU 
EQU 
EQU 
EQU 
EQU 
EGU 
EQU 
EQU 
EQU 
EQU 
EGU 
EQU 
EGU 
EQU 
EQU 
EQU 
EQU 
EQU 
EQu 
EQU 
EQU 


2 $;BREAKPOINT ADDRESS 

OFFH 3;INPUT BUFFER 

1 3$STORE CRT CHARACTER HERE 

2 sEND ADDRESS BUFFER 

i ;SOO0LEAN FLAG 

Z ;HEX BUFFER 

i sCONTENTS OF BREAKPOINT LOCATION 

2 $START ADDRESS BUFFER 

18H sREG STORAGE 

30H sMODEL VARIABLE STORAGE 

a ;MODEL FLAG FOR SUBROUTINE FACTOR 

1 »;COUNTER USED TO CONTROL STORAGE 

I »>FLAG USED IN WALG 

2 3;TEMP VARIABLE 

04H 3RS-232 INPUT PORT 

04H 3RS-232 OUTPUT PORT 

O5H sRS-232 STATUS PORT 

D6H 

07H 

STAX $PE LOCATION IN Stax 

STAX+2 

STAX+G 3IY LOCATION IN STAX 

STAX4#6 35IX% LOCATION IN STAX 

STAX+8 3HL' LOCATION IN STAX 

STAX+DAH 3D0E' LOCATION IN STAX 

STAX+0CH $BC" LOCATION IN STAxX 

STAX+DEH 3AF' LOCATION IN STAX 

STAX+10H ;HL LOCATION IN STAX 

STAX+#+12H $0E& LOCATION IN STAX 

STAX+14H 3BC LOCATION IN STAX 

STAX+164 3AF LOCATION IN STAX 

MOOVAR 3R (STEP INPUT) LOCATION IN MOOVAR 
MODVAR+2 3CM (MODEL OUTPUT) LOCATION 
MODVAR+4 3CM * CORRECTION FACTOR 
MODVAR+6 3CODOT (OERIVATIVE OF CM) LOCATION 
MODVAR+8 ;CDOOT (ACCELERATION) 
MODVAR+DAH ;PREVIOUS VALUE OF VELOCITY 
MODVAR+DCH ;PREVIOUS VALUE OF ACCELERATION 
MODVAR+DEH s;PREVIOUS VALUE OF PLANT OUTPUT 
MODVAR+10H 3(T-2) VALUE OF OUTPUT PLANT 
MOOVAR+12H ;COUNTER 

MNODVAR+14H »sVOLTAGE AT THE LIMITER OUTPUT 
MODVAR+16H s;MOTOR GAIN CONSTANT 

MODVAR+13H ,;COUNTER 

MOOVAR+1AH sANALOG OUTPUT 

MODVAR+1CH sDATA TO BE DISPLAYED 
MODVAR+1EH >QUOTIENT 

MODVAR+2DH ;LSOIGIT OF A DECIMAL NUMBER 
MODVAR+22H »>SECOND DIGIT OF A DECIMAL NUMBER 
MODVAR+24H sTHIRD DIGIT 

MODVAR+206H ;FOURTH DIGIT 

MODVAR+28H 3;FIFTH DIGIT OF A DECIMAL NUMBER 
MODVAR+2AH sTEMPORARY STORAGE OF IY REG. 
MODVAR+2CH ;CORRECTOR FACTOR 

MOOVAR+2EH s;COUNTER FOR WIKSTROM ALGORITHM 
OF7H s;OPCODE FOR RST30 

0 sBOOLEAN VARIABLE 

OFFH sBOOLEAN VARIABLE 

8 SASCII BACKSPACE 
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FWDARW 
ES¢ 
SPACE 
CR 

EF 


5 


MR1 
MR2 
CMD 


RESET: 


RST30: 


INTM1: 


? 


NMINT : 


> 


b 
b 
> 


MONINIT: 


5 
MONLOOP : 


5 
MONITOR: 


EQU 
EQU 
EQU 
EQU 
EQU 


EQU 
EQU 
EQU 


CSEG 


LO 
J? 


ORG 
JP 


OCH 
18H 
20H 
ODH 
OAH 


sASCITI 
sASCIT 
,sASCII 
3ASCII 
3ASCITI 


FOREWARD ARROW 
ESCAPE 

SPACE 

CARRIAGE RETURN 
LINES Fea 


RS-232 PORT CONFIGURATION WORDS 


OCEH 
70H 
5 


SP ,1600H 
MONINIT 


30H 
TRAP3O 


38H 
O9COH 


66H 
O9A0H 


MONINIT PUSHES ALL THE REGISTERS ONTO THE STACK BEFORE 
ENTERING THE MONITOR 


ORG 
LD 
OUT 
LD 
OUT 
LD 
OUT 
CALL 
ED 
CALL 
CALL 
LD 
CALL 
CALL 
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A,MR1 
(RSMODE)>A 
A,»MR2 
(RSMODE ),A 
A,CHD 
(RSCMD),A 
SERER 

IX »>MONMSG 
MESSAGE 
SCRLF 

IX ,TYPMSG 
MESSAGE 
SCRLF 


MONITOR 
MONLOOP 


(IXREG),IX 
IX 
(PCREG),IX 
(SPREG),SP 
(IYREG),1Y 
AF 

rx 
(AFREG),IX 
(8CREG) ,BC 
(DEREG),DE 
(HLREG),HL 
AF ,AF’ 


AF 

Im” 

(AFALT ),1X 
(SCALT),BC 
(OEALT );DE 
(HLALT ),HL 
A,(RSSTAT } 
Z 

NZ ,COMMAND 
IX,CAFALT } 


$MOVE CURSOR TO NEXT LINE 

3SET PTR TO MON MESSAGE 
;PRINT"HI ROBERTO, I AM READY!" 
;MOVE CURSOR TO NEXT LINE 

$SET POINTER TO TYPE MESSAGE 
TORU Pee sass Dot aan” 


s;INVOKE MONITOR 
>LOOP FOREVER 


3SAVE IX AT MONITOR ENTRY 
$GET PC AT MONITOR ENTRY 
3STORE PC IN STAX+PCDIS 
$SAVE SP AT MONITOR ENTRY 
ysave LY VAT MONITOR ENTRY 
>PUSH A & F 

>GET A& F 

3STORE AF 

»STORE BC 

$STORE DE 

sSTORE HL 


3;PUSH A‘ & F' 

31% <-- AF' 

SSTORE AF 

FS tORG oc: 

SS TORE Uc 

sSTORE HL' 

3;GET CONSOLE STATUS 
31S A CHAR READY 

$G0 TO COMMAND DECCDER 
sRESTORE AF‘ 
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PUSH IX 
POP AF 
LD BC ,{(BCALT ) ;RESTORE wee. 
LO DE,( DEALT ) >RESTORE DED 
LD HL»{HLALT ) ;RESTCRE ne. 
EX AF ,AF* SRESTORE ALL ALT REGS 
EXX 
LD HL»{HLREG) ;RESTORE HE 
LD DE ,»{DEREG ) 3RESTORE DE 
LD BC ,{BCREG ) ;RESTORE BC 
LD IX ,(AFREG ) >RESTORE AF 
PUSH IX 
POP Ale 
LD TY »( IYREG} SRE STORE) Ly 
LO SP ,(SPREG) ;RESTORE SP 
LD IX, (PCREG ) sRESTORE PC 
PUSH IX 
LO IX,( IXREG) SRESTORE IX 
RET 
5 
> 
DS al 
END 
5 THIS PROGRAM DISPLAYS THE CONTENTS GF MEMORY FROM THE 
5 STARTING ADDRESS TO THE END ADDRESS 
b 
1Zo0 
PUBLIC GO,LIST,REG,REGDISP ,GHEXERR,DIS,TRF »MOD,HELP 
EXTRN BACKSP ,BXPT ,BCUT ,BUFFIN,CHAR ,CHGREGS »COMMA>CR 
EXT RN EADDRESS »EAMSG,ECHO,ERRMSG,ESC ,FALSE , FLAG » FADARW 
EXTRN GETADDR ,GETCHAR ,»GETSTRIN,HEXCNY »>HEXCONV ,HEXMSG , LINENO » MESSAGE 
EXTRN OPCODE ,REGMSG »>RSTART30 ,SADDRESS »SAMSG »SCRLF ,SCROLL ,SPACES 
EXTRN TEMP» TRUE ,DISPLAY » TRANSFER , MODEL »DISMSG » TRANMSG »MODMSG 
EXTRN STAX »SPREG»)PCREG»AFREG , IXREG»IYREG,AFALT ,»H1»H2,H3,H4,H5,H6 
EXTRN H7,H8 
5 
REGLENGHT EQU 8 sLENGHT OF REGLIST 
> 
GHEXERR: LD B>% 
CALL SPACES 
LD IX »>HEXMSG »LOAD HEX CONVERSION MSG 
CALL MESSAGE 
CALL SCRCUF 
GO: LD S52 ,oEt 2 SPACES 
CAEL SPACES sPRINT 2 SPACES 
CALL GETSTRIN sGET CMD STRING FOR GO 
Crt HEXCONV ;CONVERT ASCII TO HEX 
JR C,GHEXERR ;IF CARRY IS SET DESPEAY ERROR Hse 
LD {PCREG),DE SENTER START ADDRESS 
XOR A ;CLEAR A 
CP (IX) $IS THERE A SREAKPOINT 
JR Z GOEXIT 3NO, EXIT 
LD A » COMMA 3A <== COMMA 
CP (HL) 5IS CHARACTER A COMMA ? 
JR NZ ,»GOEXIT SLE IT 2S. NOT jean, 
INC ne sADJUST PTR TO NEXT CHAR 
CEC (IX) sADJUST CHAR COUNT 
CAL HEXCNYV ;sCONVERT ASCII TCSHE~ 
JR C »>GHEXERR 3IF CARRY IS SET OISPLAY ERROR MSG 
LO A,(DE} 3GET CONTENTS OF BREAKPT 
LD (OPCODE),A ;AND SAVE IN OPCCDE 
LD (BKPT ),DE >SAVE BREAKPOINT 
LD A»RSTART3O 3GET OPCODE FOR RSTSO 
LD (DE),A ;INJECT RS57130 CPEOGE 
GOEXIT: CAEL SCRLF 
RET 
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5 
CHE AERR: 


Elon : 


LOADEND: 


NEWLINE : 


GETABYTE: 


ProrexiT;: 


5 
CHANGE : 
CHGASIN: 


NOENTRY : 


CALL 
RET 


B,>G 

SPACES 

IX, HEXMSG 
MESSAGE 

SCRLF 

B,2 

SPACES 
GETSTRIN 

HE XCONV 
C,LHEXERR 
(SADDRESS ),DE 
A 

(Ix) 
Z,LOADEND 

HL 

(IX) 

HE XCNYV 
C,LHEXERR 
(EADDRESS},DE 
SCREF 

LINENO 
HL,(SADDRESS ) 
A,(HL) 

BOUT 

A,( FLAG) 

TRUE 

Z CHANGE 

B»2 

SPACES 
DE,(EADDRESS ) 
A 

HL>DE 

NC ,LISTEXIT 
HL,(SADDRESS ) 
HL 

(SADDRESS ),HL 
A yl 

OFH 

NZ ,GETABYTE 
SCRE 

SCROLL 

&, (CHAR) 

ESE 
Cselsclenll 
NEWLINE 

SCRLF 


B,2 

BACKSP 
GETSTRIN 
A,(BUFFIN) 
0 
2,NOENTRY 
B,A 

1 
Z,CHGAGIN 
(TEMP }),A 
HEXCONV 
HL,(SADDRESS } 
Cis) 
A,(TEMP ) 


LOAD HEX CONVERSION MSG 


pooliea oF ACES 

>PRINT 2 SPACES 

3GET CMD STRING FOR LIST 

s;CONVERT ASCII ADDRESS 

3I1F CARRY IS SET DISPLAY ERROR MSG 
SSeRTeeUEREoo <-- DE 

3CLEAR A 

>IS THERE AN END ADDRESS 

;NO, DEFAULT TO Q 

;ADJUST PTR TO NEXT CHAR 

»ADJUST CHAR COUNT 

;CONVERT ASCII ADDRESS 

3IF CARRY IS SET DISPLAY ERROR MSG 
SEND eUGRESS <-- DE 


;DISPLAY ADDRESS 
»GET MEMORY POINTER 
3GET MEMORY BYTE 
sDISPLAY MEMORY BYTE 


31S THE CHANGE FLAG SET 
3YES, CHANGE A BYTE 
;SETUP FOR 2 SPACES 
;PRINT 2 SPACES 

3;DE <-- END ADDRESS 
;CLEAR CARRY 

SiS SIAR) => END 

3NO, EXIT 

sGET MEMORY POINTER 
s;INCREMENT START ADDRESS 


»>GET SADDRESS.LOW 

3IS THIS A NEW LINE 

3NO, GET A NEW BYTE 

3MOVE CURSOR TO NEW LINE 
3START & STOP SCROLLING 
$GET SCROLL CHAR 

3IS IT AN ESCAPE 

SYED, EAIT 

>START A NEWLINE 

3NO, ADJUST CURSOR & EXIT 


$SETUP FOR 2 BACK SPACES 
3BACK SPACE 2 SPACES 
>GET ANY NEW CHARACTERS 
>GET STRING LENGTH 

3IS STRING LENGTH = 0 


3IS STRING LENGTH <2 
3YES, DO IT AGAIN 

3SAVE STRING LENGTH 
sCONVERT BYTE TO HEX 
SRESTORE FL PTR 

;S10RE CHAR IN BYTE 

$SET CURSOR RESTORE BASE 
sNEGATE STRING LENGTH 
SAO ee TO RESTORE BASE 
per GO ABIUST EXIT 


5IF PLUS RESTORE CURSOR 


103 


CHANGEX: 


CHGREG: 


CHGALT: 


LOADLIST: 


REGSCAN: 


REGEXIT: 


REGERR: 


> 

CHGSP: 
CHGPC: 
CHGIX: 


CHGIY: 
REGCONT: 


HL,(SADDRESS ) 


SCRLF 

IX ,>REGMSG 
REGDISP 

IX ,CHGREGS 
MESSAGE 
SCREE 
GETCHAR 
ECHO 
A,(CHAR } 
(TEMP ),A 
CR 
Z,REGEXIT 
ne 

Z »CHGSP 

ye 
Z,»CHGPC 
mnseee 

2 ,CHGIX 
eve 
Z,CHGLY 
GETCHAR 
ECHO 
A,(CHAR ) 

2 »>CHGALT 
CR 
NZ,REGERR 
HL,AFREG+1 
LOADLIST 
HL ,AFALT+1 
IX ,REGLIST 
B,REGLENGHT-1 
A,(TEMP ) 
CIx) 
Z,»REGCONT 
IX 

HL 

REGSCAN 
IX,ERRMSG 
MESSAGE 
SCRLF 


IX, ERRMSG 
MESSAGE 


HL,SPREG+1 
REGCONT 

HL ,PCREG+1 
REGCONT 

HL ,IXREG+t1 
REGCONT 
HL,IYREG+1 
fake 

B>% 

SPACES 
GETSTRIN 
HEXCCNV 

HL 

A,( TEMP ) 
wan 

Z,AORF 

ee 

Z»,AORF 

A,D 

(HL)>A 


sRESTORE HL BEFORE RETURN 


sSETUP REG A MESSAGE 
;DISPLAY REGISTERS 

»SETUP REG CHANGE MESSAGE 
>"ENTER REG TO CHANGE" 


3GET SELECTED REGISTER 
3ECHO REG NAME TO CRT 


3NO CHANGE? 
,YES, sexo 
s;CHANGE SP? 
3YES, JUMP CHGSP 
3;CHANGE PC? 
3sYES, JUMP CHGPC 
»sCHANGE IX? 
3;YES, JUMP CHGIX 
s;CHANGE IY? 
sYES, JUMP CHGIY 
3GET NEXT CHAR IN CMD 


3IS REG AN ALTERNATE 
sYES, CHANGE ALT REG SET 
JEMOL Oe CHbz 

3NO, JUMP REGERR 

»>GET PTR TO REGS ON STAX 


3GET PTR TO REGS ON STAX 
3GET IX TO “AFBZDZHZ2" 
3SET REGLIST COUNT 
sRETRIEVE REG NAME 

3IS REG = SELECTED REG 
sYES, OUTPUT CONTENTS 
3POINT TO NEXT REG 
sPOINT TO NEXT REG 

3GET NEXT REGLIST 

>REG NOT FOUND GET ERRMSG 
s"ERROR RE-ENTER" 


$GET SP AT VHMON ENTRY 
3GET NEW CONTENTS 
3;GET PC AT MON ENTRY 
;GET NEWeCONTENTS 
3;GET IX AT MON ENTRY 
>GET NEW CONTENTS 
3GET ITY AT MON ENTRY 
;SAVE HL 


3PRINT 4 SPACES 

3GET NEW REG CONTENTS 
sCONVERT CONTENTS TO HEX 
SRESTORE THE 


sIS REG A? 

sYES, GO TO AORF 

31S REG F? 

xYES, GO TO AORF 

$GET HI BYTE OF HEXBUr 
sLOAD REG PAIR HI BYTE 
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AORF : 


> 
REGDISP: 


5 
ONEREG: 


> 
REGPAIR: 


5 
REGDUMP : 


DIS: 


ee: 


MOD: 


HELP: 


EALL 


CALL 
CALL 
CALL 
RET 
CALL 
LD 
CALL 
CALL 
GALL 
RET 
CALL 


CALL 
CALL 
CALL 
RET 
CALL 
LD 
CALL 
Gack 
CALL 
LD 


HL 

A,E 
(HLI,A 
SCRE 
REGEXIT 


HL,AFREG+1 
C,2 

ONEREG 

C,3 
REGPAIR 
HLE> EXREG+1 
C2 
REGPAIR 
SEREE 
HL,AFALT+1 
C>2 

ONEREG 

C53 
REGPAIR 
HL,»SPREG+1 
C>2 
REGPAIR 
SCREF 


MESSAGE 
REGDUMP 
ix 

C 
NZ,ONEREG 


MESSAGE 
REGDUMP 
REGDUMP 

Ix 

C 
NZ,REGPAIR 


A,(HL} 
BOUT 
HL 


SCREE 

Ix ,>DISMSG 
MESSAGE 
SCKEE 
DISPLAY 


SCREE 

IX» TRANMSG 
MESSAGE 
SCRLF 
TRANSFER 


SEREE 

IX ,MODMSG 
MESSAGE 
SCRLF 
MCDEL 


SECREE 
IX,H1 
MESSAGE 
SCRLE 
SCRLF 
IX ,H2 


sPOINT TO LOW REG PAIR 
3GET LO BYTE OF HEXBUF 
LOAD REG PAIR LOW BYTE 
;OUTPUT CR AND LF 

DEALT 


;POINT TO A & F IN STAX 
3SET LOOP FOR A AND F 
sDISPLAY A & F 

3SET FOR 3 REGS 
;DISPLAY BC,DE, & HL 
sPOINT TO IXREG IN STAX 
35E1 FORTS REGS 
»DISPLAY BC,DE, & HL 


»POINT TO A' & F' IN STAX 
3SET LOOP FOR A' AND F' 
SDISPLAY A' & F' 

joc eOResg KEGS 

;DISPLAY BC',DE', & HL' 
3POITN TO SP & PC 

FoET FOR ec REGS 

sDISPLAY SP & PC 
$GENERATE CR & LF 


5 "AF ve 

SDISPLAY REG CONTENTS 
;POINT TO NEXT MSG 

»DEC REG LOOP COUNTER 
sMORE REGS GO TO ONEREG 


eure at 

;DISPLAY REG CONTENTS 
SDISPLAY REG CONTENTS 
$POINT TO NEXT MSG 

>DEC REG LOOP COUNTER 
§MORE REGS GO TO REGPAIR 


3GET REG 
sOUTPUT REG TO CRT 
>POINT TO NEXT REG 


,IX<--- MESSAGE ADDRESS 

} ee lSrear THE RESULTS” 
»DISPLAY RESULTS ON SCREEN 
3IX<--- MESSAGE ADDRESS 
,"TRANSFER MODEL TO RAM" 
3TRANSFER MODEL TO RAM (1000) 
5IX<--- MESSAGE ADDRESS 

>" RUN YOUR MODEL" 


»RUN MODEL 


REGEEST: 


> 
> 
- 280 

PUBLIC 
EXTRN 
EXTRN 

5 
COMMAND : 


CALL MESSAGE 
CALL SCREF 
CacEe SCREE 
LD IX,H3 
CALL MESSAGE 
CALL SEREF 
CAEL SEREF 
LD IX HG 
CALL MESSAGE 
GALL SCREF 
CALL SCREF 
LD IX,H5 
CALL MESSAGE 
CALL SGREE 
CALL SEREF 
LD IX,Ho 
ALL MESSAGE 
CALL SCREE 
CALL SCRLE 
LD IX,H? 
CALL MESSAGE 
CALL SCRLF 
CALL SGRLF 
LD IX >H8 
CALL MESSAGE 
CALL SERLF 
CALL SCRLF 
Rew 
DC Vv mE BeUCh ee. 
DS Zi 
END 


THIS PROGRAM DECODES COMMANDS AND INVOKES THE PROPER 


COMMAND ROUTINES 


COMMAND 


CHAR »ECHO ,ERRMSG, FALSE » FLAG ,GETCHAR »GO,LIST »MESSAGE , HELP 
REG ,»SCRLF ,TRUE ,DIS,TRF ,MOD 


CALL GETCHAR 
Cab L ECHO 

LD A» (CHAR) 
CP “Ga 

JP Z»GO 

LD HL»FLAG 
LD (HLJ,TRUE 
Ce ce 

JP Zo biST 

LD CHE ISFAESE 
CP se 

JP Z»,LIST 

CP Re 

JP Z,REG 

CP “Dy 

JP Z,D0IS 

cP we 

JP Z>TRF 

CP ee 

JP Z»MOD 

CP “TAs 

JP Z,1000H 
CP asi 

JP Z,HELP 

LD IX ,ERRMSG 
CALL MESSAGE 
CALL SCRUF 

RET. 

END 


3GET A CHAR FROM CRT 
3ECHO CHAR BACK TO CRT 
;GET CMD CHAR 

$IS CHAR A "G" 

SYES> EXECUTE CODE 


sSET CHANGE FLAG 

;1S CHAR GAC 
sYES,CHANGE MEMORY 

3CLEAR CHANGE FLAG 

;LS CHAR Ae” 

3NO, LIST MEMORY 

$IS CHAR AN "'R" 

3YES, DISPLAY REGS 

3IS CHARACTER & "DD"? 
,YES,DISPLAY RESULTS 

$IS CHARACTER A? 
$TRANSFER MOCEL TO RAM 
,1S CHARACTER AN “G7 
3RUN MODEL 

sIS CHARACTER VANS tae 
36GO TO RAM, ADDRESS 1000H 
$15 CHARACTIR AN} fie 
3LF YES, GO TO HELP CIN EIST) 
;GET ERROR NESSAGE PTR 
SPRINT “ERROR RE-ENTER: 
sMOVE CURSOR TO NEXT LINE 


THIS PROGRAM DECODES COMMANDS AND INVOKES THE PROPER 
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5 

. 280 
PUBLIC 
EXTRN 
EXTRN 


> 
COMMAND : 


5 
5 

280 
EXTRN 
PUBLIC 
PUBLIC 
NULL 


° 


> 


MESSAGE : 


MSGRET: 
CHGREGS: 
EAMSG: 

ERRMSG: 
HEXMSG: 
MONHSG : 


REGMSG : 


SAMSG: 


TYPMSG: 


COMMAND ROUTINES 


COMMAND 


CHAR ,ECHO,ERRMSG , FALSE ,FLAG,GETCHAR,GO,LIST »MESSAGE ,HELP 
REG ,SCRLF,TRUE ,DIS,TRF ,MOD 


CALL 
CALL 
RET 
END 


GETCHAR 
ECHO 

A, (CHAR } 
'S! 

<»GO 

HL »FLAG 
(HL J,TRUE 
“Cc? 
Zoatlsv 
(HLJ,FALSE 
ealines 
Z,LIST 
'R! 
Z»REG 

“oo 
z,DIS 

he 
CouRr 

‘Ee! 
z»MOD 

um 4 
Z,1000H 
'H! 

25 0ELP 

IX ,»ERRMSG 
MESSAGE 
SCRIEF 


sGET A CHAR FROM CRT 
;ECHO CHAR BACK TO CRT 
>GET CMD CHAR 

3IS CHAR A "GC" 

piESG ese CUUe CODE 


$SET CHANGE FLAG 

$IS CHAR A “Cc” 

3YES »>CHANGE MEMORY 

;CLEAR CHANGE FLAG 

SIS SEAR AD'S” 

3NO, LIST MEMORY 

$IS CHAR AN "R" 

sYES, DISPLAY REGS 

SES CnaReCTER A “D"? 
SYES>DISPLEAY RESULTS 

3IS CHARACTER A "T''? 
>;TRANSFER MODEL TO RAM 
$IS CHARACTER AN "E''? 
sRUN MODEL 

3IS CHARACTER AN "M" ? 
3GO TO RAM, ADDRESS 1000H 
3IS CHARACTER AN "KH" ? 
Pitates>, Goaro neLP CIN LIST ) 
sGET ERROR MESSAGE PTR 
SPRINT “ERROR RE-ENTER” 
sMOVE CURSOR TO NEXT LINE 


THIS PROGRAM OUTPUTS MESSAGES TO THE CRT SCREEN 


ECHO 


CHGREGS ,EAMSG , ERRMSG » HEXMSG »MESSAGE ,MONMSG »REGMSG ,SAMSG 
TRANMSG »MODMSG » HELLO ,DISMSG »TYPMSG,H1,H2,H3 ,H4¢,H5,H6,H7,H8 


EQU 


LD 
CP 
JR 
CALL 
INC 
JR 
RET 
DC 
DC 
DB 
OC 


0 


A, (IX) 
NULL 
Z»MSGRET 
ECHO 

IX 
MESSAGE 


sASCII NULL SYMBOL 


3GET MESSAGE CHAR 

$IS CHAR = NULL 

3YES, RETURN 

;OUTPUT CHAR TO CONSOLE 
»INCREMENT MESSAGE PTR 
»>GET ANOTHER CHARACTER 


“ENTER REGISTER YOU WANT TO CHANGE" 
" (A,F,B(BC)},D(DE),H(HL),S(SP),P(PC)]" 


NULL 

“END ADDRESS " 

NULL 

“ERROR RE-ENTER" 

NULL 

pie CONVERSLONGERROR...RE-ENTER" 

NULL 

“*UTOADAPTIVE CONTROL FOR A ROBOT ARM" 

NULL 

"A=",NULL »" =""JNULL," BC=",NULL," DE=" 
NULL," HL=",NULL," IX=",NULL," TY=",NULL 
Peg NOLi>. Fs NUBL, BO'™,NULL,” DE'™ 
NULL," HL'',NULL>" SP=",NULL," PC=",NULL 
[StaktsAODRESS ” 

NULL 

Pitre src etd) RUN MODEL; ™ 


Loy 


OC "'D" TO DISPLAY THE RESULTS, * 


DC “SR tO GET HELP.” 
DBS NULL 

TRANMSG: 88 “TRANSFER MODEL FROM EPROM TO RAM ADDRESS 1000" 
DB NULL 

DISMSG: DC “OUISPLCAY RESULTS” 
0B NULL 

MODMSG : oC "RUN MODEL" 
DS NULL 

MELEO: DC "PLEASE ENTER ANGLE POSITION. MAXIMUM IS 7F" 
DB NULL 

nl: DC "1.TO RUN THE PROGRAM, TYPE <E>.ENTER ANGLE(HEX)," 
DC “RESET THE INTEGRATORS IN THE ANALOG PLANT AND HIT" 
oC “SRETURN>.TO STOP THE PROGRAM, PRESS THE RESET SWITCH" 
D8 NULL 

He: BC "2.70 DISPLAY THE RESULTS OFF LINE (LAST RUN),TYPE <D>" 
DB NULL 

mss DC "3.TO TRANSFER THE PROGRAM TO RAM (AD. 1OQ0H),TYPE <T>" 
DB NULL 

HG: DC "4.TO RUN THE PROGRAM IN THE RAM, TYPE <M>." 
DB NULL 

nS: c "S.TO LIST THE MEMORY FROM ADDRESS XXXX TO Yy11; Tree. 
DC " TESRE T SRNR SY SRE ae 
DB NULL 

Ho: DC "6.TO CHANGE DATA OR ENTER MACHINE LANGUAGE PROGRAM" 
DC "INTO RAM BETWEEN THE ADRESSES XXXX AND YYYY, TYPE:" 
DC "'CCRETOXXXX >YYYYSRET>. TYPE <RET> TO SROWSE THE " 
DC "MEMORY" 
D8 NULL 

H7: DC "7.70 RUN A PROGRAM IN THE RAM TYPE: G<RET >XXXX ,Z2Z22Z" 
DC “CRET> WHERE 2Z2Z IS THE BREAKPOINT OF STE PROGRAM. | 
DC "THE CPU REGISTERS WICL BSE SHONN ON! TRESSCREEH 
DB NULL 

H8; DC "“S.TO SEE THE CPU REGISTERS, TPE che 
o8 NULL 
END 


5 
$THIS PROGRAM CONTAINS THE ROUTINES TO GET CHARACTERS FROM THE CRT 
SKEYGOARD AND SEND THEM TO THE SCREEN. FILE IS “CONSOUE™ 


? 


EXTRN CHAR,REC,RSSTAT »>XMIT 
PUBLIC GE TCHAR »ECHO 
GETCHAR: IN Ay(RSSTAT ) $GET CONSOLE STATUS 
AND é 3IS A CHAR READY ? 
JR Z»GETCHAR 3NO, CHECK AGAIN 
IN A,(RECV) sYES, GET RS232 DATA 
AND 7EG ;PARITY STRIP 
LO (CHAR),A sSTORE INPUT IN CHAR 
RET 
ECHO: LD E,A 3TEMP CHAR STORE 
CKAGIN: IN A,(RSSTAT ) 3GET CONSOLE STATUS 
AND iE 3IS XMIT READY 7 
JR Z »CKAGIN 3NO, CHECK AGAIN 
LD A,E 
OUT (XMIT),A sYES, SEND DATA OUT 
RET 
cS t 
END 
> 
5 THIS PROGRAM CONVERTS THE STRING IN BUFFIN INTO A HEXIDECIMAL NUMBER 
, 
=P | BUF FIN,HEXSHIFT,LF ,SEVEN, THIRTY 
PUBLIC HEXCONV , HEXCNY , COMMA 
» 
CLEAR EQU OOH sINITIALIZATION VALUE 
COMA EQU 2CH SASCII COMMA 
HT EQU O9H 3ASCII HORIZONTAL TABULATION 
DLE EQU 1OH sASCIIT DATA LINK ESCAPE 


10S 


5 
HEXCONV : 


) 
HEXCNYV: 


HEXLOOP: 


ZEROCK: 


eMe dy: 
ENDCONV: 
HEAERR: 


$ THIS PROGRAM 
> 

PUBLIC 

> 

HEXSHIFT : 


Shirt : 


LD HL ,BUFFIN+1 


CALL HEXCNV 
RET 


sINITIATE BUFFIN PONITER TO BUFFIN(1) 
;CONVERT THE START ADDRESS TO HEX 


THIS ROUTINE PERFORMS THE ASCII TO HEX CONVERSION 


;CLEAR HEXIDECIMAL REGISTERS 

»SET IX REG AS A STRING LENGTH POINTER 
sEVALUATE STRING LENGTH 

3IS THE STRING LENGTH EQUAL TO ZERO 
3IF LENGTH EQUALS ZERO EXIT ROUTINE 
»GET CHARACTER FROM BUFFIN 

3IS CHARACTER A COMMA ? 

LE he to eal’ ROUTINE 

3Ae-— CHAR -350n 

SCHAAR’ <—-— ak REO 

31S CHARACTER OAH ? 

34 2S LESS THAN OAH GO TO ZEROCK 
>A <== CHAR - 07H 

s;CHAR <-- A REG 

52S CHARACTER A O9H 7? 

ple elomeeoo, HHAN O9H GO TO HEXERR 
>IS CHARACTER A 10H ? 

$IF GREATER THAN 10H GO TO HEXERR 
$[1S CHARACTER A ZERO ? 

,IF LESS THAN ZERO GO TO HEXERR 
;PROVIDE THE SHIFT IN THE HEX REGISTER 
$INCREMENT BUFFIN POINTER 
»>DECREMENT STRING LENGTH 

;CLEAR ACCUMULATOR 

jlo (HERE MORE CHARACTERS ? 

pir feo Geb NEXT CHARACTER 

»NO ERROR »SO CLEAR CARRY 


sERROR ,SO SET CARRY 
sEXIT SUBROUTINE 


PROVIDES THE SHIFT OF THE HEX ADDRESS INTO THE HEX REGISTERS 


LD DE,CLEAR 
LD IX ,BUFFIN 
LD A,(IX) 
CP CLEAR 

JR Zoe ny 
ED A,(HL) 
CP COMMA 

JR Z EMPTY 
SUB TRIRTY 
LD {HL),A 
CP LF 

JP M,ZEROCK 
SUB SEVEn 

LD (HLJ,A 
CP HT 

JP M,HEXERR 
CP DEE 

JP P,HEXERR 
cP CLEAR 

JP M,HEXERR 
CALL HE XSHLET 
INC HL 

CEC (IX) 

XOR A 

CP (IX) 

JP NZ »HEXLCOP 
OR A 

Red 

Set 

JR ENDCONV 
0S 4 

END 

HEXSHIFT 

LD B,0OGH 

OR A 

SLA E 

RL D 

DJINZ SALET 

LD A,(HL) 
OR E 

LD E,A 

Rew 

DS a 

END 


3B <-- 04 

3;CLEAR CARRY 

ponlrveterl & CONTENTS THROUGH CARRY 
sROTATE LEFT D CONTENTS FROM CARRY 
sARE THE FOUR SHIFTS COMPLETED ? 

3A <-- CONVERTED CHARACTER 
$SUPERIMPOSE THE CONTENTS OF E AND A 
3E <-- A REG 


> THIS PROGRAM GETS A STRING OF CHARACTERS FROM THE CRT THAT WILL BE 
CONCATENATED BY CONCAT 


> 

> 

EXT 
BUoLIC 
5 

ZERO 


> 
GETSTRIN: 


BULED: 


BUFFIN,CONCAT,CR,ECHO,GETCHAR 


GETSTRIN 

EQU OOH 

LD C,ZERO 

LD HL,BUFFIN 
INC HL 

CALL GETCHAR 

CP CR 

JR Z »STRINGEX 


;INITIAL VALUE OF COUNTER 


S;COUNTER INITIALIZATION 

;INITIATE BUFFIN POINTER 

sPLACE POINTER INTO BUFFIN( 1) 

;READ CHARACTER FROM CRT 

3IS THE CHARACTER A CARRIAGE RETURN ? 
SEL) > SUMP 10° STINGEX 
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CACE ECHO SDISPLAY CHARACTER 


CALL CONCAT s;CONCATENATE THIS CHAR WITH THE OTHERS 
JR BUILD 3GET NEXT CHARACTER 
STRINGEX: LD A,C $A REG <-- NUMBER OF CHAR IN STREMG 
LO (BUFFIN),A ;STRING LENGTH IS STORED IN SubeeiiGoy 
RET 
> 
DS 2 
END 
5 THIS PROGRAM DISPLAY THE STARTING ADDRESS OF THE CURRENT 
5 LINE 
5 
- 280 
PUSLEC LINENS 
EATRN BOUT »,SADDRESS »SPACES 
> 
LINENO: LD A,(SADDRESS+1)  $GET MSB CURRENT ADDRESS 
CALL BOUT ;DISPLAY HI AOORESS BYTE 
LD A, (SADDRESS ) 3GET LSB CURRENT ADDRESS 
CALL BOUT sDISPLAY LOW ADDRESS BYTE 
Lp BB» ;oETUP FOR 4 SPACES 
CALL SPACES sPRINT 4 SPACES 
RET 
DS i 
END 
5 THIS PROGRAM SENDS OUT A CARRIAGE RETURN AND LINE FEED 
> 
- 280 
5 
PUBLIC BACKSP > SCRUF >SCROLL SPaCeEs 
EXTRN BS »>CHAR>»CR»,ECHO,ESC ,GETCHAR>LF »RSSTAT 
EXTRN FWDARW 
> 
BACKSP: LO A,»,BS $A <-- BACK SPACE 
CALL ECHO $SEND SPACE TO CRT 
DJINZ BACKSP 3YES, GOTO SPACES 
Rea 
> 
SCRLF : LD A,CR 3A <== ASCIT RETURN 
CALL ECHO >SEND A RETURN TO CRT 
LD A,LF ;A S==" ASCE LINew eeu 
CALL ECHO $SEND A LINE FEED TO CRT 
RET 
5 
SPACES: LD A,FWDARW $A <-- FOREWARD ARROW 
CALL ECHO ;SEND SPACE TO CRT 
DJINZ SPACES sYES, GOTO SPACES 
Rew 
? 
SCROLL: IN A, €RSSTAT ) 3GET CONSOLE STATUS 
Ce 2 $IS A CHAR READY 
JR NZ»,SEAIT sNO, EXIT 
CALL GETCHAR sYES, GET THE CHARACTER 
LD A,(CHAR ) 3A <-~- CHAR 
CP FSG 3IS THE CHAR AN ESCAPE 
JR Ze SEALY SYES, TERMINATE SCROLL 
PAUSECK: IN A, €RSSTAT ) ;GET CONSOLE STATUS 
CP 2 3IS A CHAR READY 
JR NZ ,PAUSECK 3NQO, CONTINUE PAUSE 
CALL GETCHAR ,;CLEAR REG Rae 
SEALS: RET 
OS 1 
END 
5 THIS PROGRAM GETS AN ASCII ADORESS AND CONVERTS IT TO HEX 
5 
> 
- 280 
PUSLIC GETAOOR 
EXTRN BUFFIN,GETSTRIN,HEXCONV ,MESSAGE »SCRLF 
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5 
GETADDR: 


ADDREXIT: 


we we we 


END 


SCRLF 
MESSAGE 
GETSTRIN 
SCRLF 
HEXCONV 

C ,GETADDR 


i! 


THIS PROGRAM IS USED BY GETSTRIN TO 
ASCII STRING BEING FORMED 


sMOVE CURSOR TO NEXT LINE 
$PRINT ADDRESS MESSAGE 
»>GET ASCII ADDRESS 

sMOVE CURSOR TO NEXT LINE 
»CONVERT ADDRESS TO HEX 
3;ERROR, GET NEW ADDRESS 


CONCATENATE THE CHARATER ONTO THE 
IN THE INPUT BUFFER 


EXT CHAR ,BS 

PUBLIC CONCAT 

> 

CONCAT : CP BS 3IS THE CHARACTER A BACK SPACE ? 
JR 2,CORRECT fies is JUMP 10 CORRECT 
LD A»,(CHAR } 3A REG <-- LOADED CHARACTER 
LD (HL),A 3STORE CHARACTER IN BUFFIN 
INC c sINCREMENT COUNTER 
INC HL 3SET POINTER TO NEXT BUFFIN POSITION 
RET 

CORRECT: LDD Saeco ent wsbe .s-- bG-) 
RET 

5 

DS a 
END 

5 THIS PROGRAM CONVERTS THE HEX CONTENTS OF A INTO ASCII 

5 

EXT TEMP ,ECHO 

PUSLIC BOUT , THIRTY ,SEVEN ,ASCONV 

5 

MASK EQU OFH sASCITI MASK 

THIRTY EQU 30H 3ASCIT 30 

COLON EQU 3AH sASCITI : 

SEVEN EQU 07H s;ASCII a 

> 

BOUT: LD (TEMP ),A sMAKE TEMPORARY COPY OF ACCUMULATOR 
SRL A sEIRST SHIFT RIGHT OF A CONTENTS 
SRL A sSECOND SHIFT RIGHT OF A CONTENTS 
SRL A $THIRD SHIFT RIGHT OF A CONTENTS 
SRL A 3FOURTH AND LAST SHIFT RIGHT 
CALL ASCONV s;CONVERSION OF MS NIBBLE 
LD A,( TEMP } »>GET TEMPORARY COPY OF A 
AND MASK >MASK OFF MS NIBBLE 
CALL ASCONV ;CONVERSION OF LS NIBBLE 
RET ;RETURN TO CALLING ROUTINE 

5 

3} THIS SUBROUTINE WORKS WITH 'BOUT' TO PERFORM THE HEX TO ASCII CONVERSION 

> 

ASCONV ADD A,THIRTY 3ADD 30H TO HEX NIBBLE 
CP COLON sCOMPARE THE RESULT OF SUM WITH COLON 
JP M,ASCOUT Mee 1S LESS THEN -COLGN JP .1C: ASCOUT 
ADD A »SEVEN ,ACE 7 SOR A=F OFFSET 

ASCOUT : CALL ECHO PUTSPEAY THE ASCII CHARACTER 
Re 360 BACK TO ‘BOUT' 

$ 
DS a 
END 

i. THIS PROGRAM RESTARTS THE MONITOR AFTER A BREAKPOINT 

5 

EXT BKPT ,OPCODE ,REGDISP ,REGMSG ,»MONLOOP ,MONITOR 

PUBLIC TRAP30 

5 

TRAP30: CALL MONITOR $SAVE REGISTERS 
LO A», (OPCODE } 3A <--OQPCODE OF BREAKPOINT POSITION 
LD DE ,(BKPT } 3DE<--ADDRESS OF BREAKPOINT 
LD (DE),A ;RESTORE OPCODE IN THE PROGRAM 


ict 


IX ,»REGMSG 
REGDISP 
MONLOOP 





sPREPARE TO DISPLAY REGI 
sDISPLAY REGISTERS 
3GO TO MONLOOP AT MAIN 


ee 


to 


f. Ww 


SD 


xy 


APPENDIX C 
EQUIPMENT AND OPERATIONAL PROCEDURES 


EQUIPMENT 


The experimental system consists of the following parts: 


Three protoboards for the microprocessor. extra memories (data memories) and 
analog plant 


One video terminal 

Oaeaw) vs A power supply 

One -5 V / 3500 mA power supplv 
See oi2 ¥ / 300 mA power supply 
tee) vies DOWEL SUDpIy 


One oscilloscope for measuring the analog output. 


PROCEDURE 


In the actual configuration the objective of the hardware is to receive a 


commanded input from the keyboard (robot arm angle to be displaced) and provide the 


corresponding voltage at the plant output. This voltage represents the actual 


displacement of the robot arm and is monitored by the oscilloscope at the plant 


output. The commanded input (hexadecimal), when converted to decimal represents a 


multiple of 2.23 degrees. The minimum input allowed is | and the maximum is 7F 


(hexadecimal). In decimal they represent inputs from | to 127 and in degrees they are 


equivalent to angles between 2.23 to 284.2 dgrees, respectively. 


micewoperaional procedure 10 fun the svstem, in a step by step basis can be 


described as follows: 


Ile 


eee 


Cn 


Turn on the main power, power supplies, monitor and oscilloscope. 


Connect one channel of the oscilloscope to the. plant output (CS). A second 
channel can be used to observe the plant input (V). 


ivesct tne MiNCromrocessoOr O\ pressing the reset switch. The screen will display 
three Options (execution, display and help). Hit < E> to run the program. 
The oo will ask for the angle input. Type an hexadecimal number less_or 
equal to /FH (decimal 127). Adjust the oscilloscope scale accordingly. The 
biggest voltage will be equal to the decimal] input multiplied by 0.039 Volts. 


Keset the integrators in the analog plant. the last integrator switch must be 
released last to guarantee zero output at the beginning of the program. 


Type <ret> right after releasing the reset switch. 


eS 


10. 
ie 


The program will run and the plant output can be observed at the oscilloscope. 
The voltage on the oscilloscope represents the angle position in radians. 


Reset the mucroprocessor. 

Tvpe <D> on the keyboard to display the results. As explained in Appendix 
C, the variables will be displaved in eight columms. From left To Ment (neva 
be : Error, NDOT, ADOTE, CDDOT, CDOT, CM, CS and NN (qumibemues 
loops accomplished by the program up to that row). 

To scroll up the rows and look at some more data, hit anv kev. 

At the end of the data memory the screen will show an error message to 


indicate that there is mo more data available. To look at the data again. reset 
the nucro and tvpe <D>. 
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